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ABSTRACT 


A  truly  autonomous  aerial  vehicle  is  required  for  conducting  aerial  missions  at  distances 
great  enough  to  cause  time  lag  in  communications,  such  as  on  other  planets.  This  level  of 
autonomy  also  reduces  the  requirement  for  trained  UAV  pilots  to  fly  round-the-clock 
missions.  Development  of  optimal  canonical  maneuvers  is  a  step  towards  achieving  real¬ 
time  optimal  trajectory  generation  and  more  fully  autonomous  aircraft  capable  of 
independent  and  efficient  flight  maneuvering. 

This  thesis  develops  a  model  of  the  MONARC  aerial  vehicle  and  sets  up  the 
optimal  control  problem  for  generating  canonical  maneuver  profiles.  The  DIDO  optimal 
control  software  is  used  in  order  to  generate  time-optimal  trajectories  for  flight 
implementation  on  the  MONARC  test  bed.  The  ability  of  the  MONARC  to  fly  the 
optimal  trajectories  is  verified  using  a  6DOF  SIMULINK  model.  Several  canonical 
maneuvers  were  developed  and  optimized  to  generate  trajectories  for  multiple  flight 
scenarios.  One  of  these  cases  is  analyzed  for  implementation  as  part  of  a  Hardware-in- 
the-Loop  (HIL)  simulation.  This  HIL  test  will  verify  that  the  optimization  model  has 
sufficient  fidelity  to  be  used  to  generate  optimal  trajectories  that  can  be  physically  flown 
by  the  MONARC. 
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I.  INTRODUCTION 


A.  BACKGROUND 

Unmanned  vehicles  (UVs),  including  aircraft,  underwater  vehicles,  ground 
vehicles,  robots  and  other  more  exotic  autonomous  systems,  are  arguably  the  cutting  edge 
of  technology  in  multiple  fields.  Applications  for  UVs  can  range  from  a  broad  spectrum 
of  military  uses  to  emergency  services,  law  enforcement,  weather  prediction,  surveying, 
and  exploration  [1],  [2],  [3].  The  United  States  had  91  different  types  of  unmanned  aerial 
vehicles  (UAVs)  in  service  or  development  in  just  the  military  and  commercial  sectors  in 
2003  [4],  and  that  number  has  continued  to  grow  rapidly. 

1.  Unmanned  Vehicles 

In  addition  to  the  increase  in  number  of  military  and  government  UAVs,  there  are 
a  number  of  military  unmanned  ground  vehicles,  unmanned  underwater  vehicles,  and 
vehicles  developed  at  educational  and  research  institutions.  The  number  of  unmanned 
systems  in  just  the  United  States  alone  is  well  into  the  hundreds,  and  globally  it  is  into  the 
thousands.  UAVs  are  now  prevalent  around  the  world,  as  shown  by  the  shaded  countries 
in  Figure  1.  UAVs  are  making  such  an  impact  on  how  wars  are  fought  today  that  they 
have  even  been  categorized  by  some  as  a  “Revolution  in  Military  Affairs”  [5],  a 
distinction  reserved  for  the  advent  of  innovative  technology  that  has  sudden  and  wide- 
reaching  strategic  impact,  such  as  artillery  and  nuclear  weapons. 

The  difference  between  a  Remotely  Piloted  Vehicle  (RPV)  and  an  Autonomous 
Aerial  Vehicle  (AAV)  is  a  distinction  that  is  often  misunderstood  or  misrepresented. 
Unmanned  does  not  necessarily  mean  unpiloted,  but  can  mean  either  autonomous  or 
remotely  piloted  [1],  [2].  The  unmanned  category  just  means  that  a  human  is  not 
onboard,  and  the  category  encompasses  both  AAVs,  which  are  not  yet  completely 
autonomous,  and  RPVs,  which  are  increasingly  common  and  have  been  in  use  by  the 
U.S.  military  since  the  Vietnam-era  Firebee  RPV  [1],  [2],  [4]. 
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Figure  1.  Map  of  Countries  That  Acquired  UAVs  by  Dec.  201 1  (From  [6]) 


The  majority  of  modern  UAVs,  while  being  touted  as  autonomous  systems,  are 
still  flown  by  a  human  pilot,  using  a  handheld  remote  control  or  a  computer  interface  that 
achieves  the  same  end — a  person  must  be  piloting  at  all  times.  This  increases 
requirement  for  manning  and  makes  the  UAV  subject  to  added  accident  risk  from  pilot 
fatigue.  It  is  also  costly  to  train  a  pilot  and  to  pay  for  the  additional  support  manpower 
needed  to  keep  military  UAVs  flying  [1],  [3].  To  achieve  a  true  AAV  that  does  not 
require  a  pilot  presents  a  new  set  of  challenges,  but  solves  many  of  the  problems  with 
current  human-flown  UAVs  and  allows  for  new  and  even  undiscovered  uses. 
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2.  Trajectory  Optimization  Methods 

Finding  the  most  efficient  way  to  get  from  point  A  to  point  B  autonomously  given 
a  certain  set  of  conditions  and  boundaries  is  a  problem  that  has  been  studied  in  almost 
every  conceivable  field.  There  are  many  ways  to  optimize  a  trajectory,  depending  on  the 
goal.  This  thesis  uses  the  pseudospectral  optimal  control  theory  [7],  which  has  been  used 
for  over  a  decade  and  is  now  well-established  as  a  method  for  autonomous  motion 
planning  [8],  [9],  [10],  [1 1],  [12], 

The  cost  to  be  minimized  could  be  time,  fuel,  or  distance;  or  it  could  be  desirable 
to  maximize  an  objective  such  as  time-on- station  or  area  coverage.  This  work  addresses 
only  time-optimization  problems,  but  the  cost  function  may  be  changed  at  any  time  to 
look  at  other  objectives,  depending  on  the  goals  and  mission  of  the  aircraft. 

Creating  a  database  of  optimal  canonical  maneuvers  for  utilization  by  an  autopilot 
system  provides  a  first  step  towards  enabling  operators  to  give  commands  to  an  aircraft, 
but  not  be  required  to  actually  pilot  it — the  aircraft  can  combine  the  optimal  maneuvers  in 
succession  to  achieve  the  desired  outcome  in  an  autonomous  fashion.  This  can  be 
successfully  achieved  whether  the  goal  is  to  fly  from  one  point  to  another  as  quickly  as 
possible,  or  to  provide  persistent  surveillance. 

B.  MOTIVATION 

That  a  UAV  be  fully  autonomous  is  crucial  for  fulfilling  any  mission  that  must 
occur  at  great  distances,  such  as  on  a  remote  planet,  where  time  lags  between  sending  a 
command  and  receiving  feedback  are  prohibitively  long  for  a  human  pilot  to  control  the 
vehicle.  One-way  communication  times  vary  depending  on  the  distance  between  Earth 
and  another  planet.  For  communication  to  Mars,  the  one-way  lag  is  in  the  neighborhood 
of  14  minutes  or  longer  [13].  Waiting  a  half  hour  between  manually-commanded 
maneuvers  may  work  well  enough  for  a  ground  rover,  which  can  simply  stop  between 
commands,  but  is  impossible  for  an  aircraft  in  flight.  In  the  case  of  planets,  moons  or 
other  bodies  with  atmospheric  conditions  conducive  to  powered  aerial  flight,  a  vehicle 
capable  of  fully  autonomous  flight  would  be  invaluable  for  surveying,  observation,  and 
other  scientific  research  and  exploration  purposes. 
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A  ground  rover  on  a  planet,  moon,  or  other  body  such  as  an  asteroid  must  travel 
slowly  and  cannot  scale  cliffs,  cross  trenches,  ascend  mountains,  or  observe  large 
amounts  of  terrain  at  once.  A  Martian  AAV  could  help  fill  the  large,  vacant  niche  left 
between  ground  rovers  and  orbiting  satellites.  Such  a  craft  is  capable  of  providing  a 
closer  look  at  the  surface  than  a  satellite,  and  could  cover  much  more  area  in  a  short 
amount  of  time.  An  AAV  may  also  go  places  where  a  surface  rover  cannot. 

Arguably  the  most  famous  unmanned  vehicle  today  is  the  new  Mars  Rover 
(Curiosity),  which  landed  on  Mars  on  06  August  of  2012  [13]  and  garnered  a  great  deal 
of  public  and  press  interest.  Developed  by  NASA  and  JPL,  Curiosity  is  to  date 
successfully  conducting  its  exploration  mission  inside  Gale  Crater,  where  it  is  using  a 
suite  of  ten  scientific  instruments  to  conduct  research  and  return  data  to  Earth  [13].  The 
vehicle  has  a  mission-life  driving  distance  of  only  12.4  miles  [13],  though,  a  very  limited 
area.  Curiosity  is  semi-autonomous,  in  that  it  is  mostly  driven  via  direct  commands  from 
operators  on  Earth,  but  can  also  operate  and  navigate  on  its  own.  Autonomous  operations 
can  be  based  solely  on  wheel  rotation  count,  or  use  a  hazard  avoidance  mode  and  onboard 
camera  to  execute  simple  maneuvers  [13]. 

An  AAV  working  in  conjunction  with  a  ground  rover  and  orbiting  satellites  could 
greatly  increase  knowledge  of  Mars.  While  Curiosity  is  able  to  make  a  detailed  study  of 
a  small  area,  a  Mars  AAV  could  cover  more  area,  and  also  work  cooperatively  with  the 
rover.  The  AAV  could  send  information  about  safe  paths  for  the  rover  to  take,  or  find  the 
nearby  areas  of  greatest  interest  to  send  the  rover  to  explore.  Aerial  imagery  and 
sampling  combined  with  that  of  the  rover  could  greatly  expand  the  scientific  data 
available.  Similarly,  working  jointly  with  a  Mars-orbiting  satellite  would  allow  a  Mars 
AAV  to  investigate  areas  that  appear  interesting  from  orbit,  taking  a  closer  look  with  the 
AAV.  A  very  advanced  AAV  on  Mars  could  even  be  equipped  with  a  small  on-board 
laboratory  and  sampling  equipment,  so  it  could  land  and  take  samples  and  return  data  to 
Earth  via  satellite  uplink. 
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c. 


UAV  APPLICATIONS 


The  applications  possible  for  an  UAV  are  limited  only  by  imagination.  Virtually 
any  task  that  traditionally  uses  a  camera,  a  scientific  instrument,  a  vehicle  of  any  kind,  a 
communications  or  recording  device,  or  even  a  weapon  could  feasibly  be  performed  by 
the  right  kind  of  UAV  either  created  for  the  task  or  modified  to  perform  the  task. 

1.  Military  Applications 

The  U.S.  military  increasingly  uses  UAVs  for  a  growing  list  of  missions, 
especially  those  that  carry  a  high  risk  for  personnel.  Production  of  unmanned  aircraft  has 
outstripped  production  of  manned  aircraft,  and  unmanned  ground  and  underwater 
vehicles  are  also  increasing  in  type  and  number. 

Military  UAVs  range  in  size  from  very  small  micro-UAVs  that  can  be  launched 
even  from  the  smallest  of  deployed  surface  ships,  to  relatively  large  and  heavy  multi¬ 
mission  UAVs  that  can  carry  strike  weapons,  such  as  the  Predator,  which  was  initially 
developed  for  surveillance  and  reconnaissance  but  has  also  been  armed  since  2001  [14]. 
Drones  are  most  frequently  used  as  surveillance  craft,  but  the  mission  applications  are 
broadening  as  UAVs  become  more  sophisticated  and  more  accepted  by  the  military  and 
government  leadership. 


Figure  2.  A  Ship-Launched  Pioneer  UAV  and  a  Predator  UAV  Armed 

with  a  Flellfire  Missile  (From  [1],  [14]) 
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UAVs  are  being  developed  for  use  as  refueling  platforms,  communications  relays, 
search-and-rescue  craft,  and  targeting  platforms.  An  impressive  variety  of  instruments 
and  equipment  may  be  outfitted,  ranging  from  cameras  to  RADAR  to  lasers.  A  joint, 
multi-mission  AAV  platform  would  be  highly  desirable  in  today’s  budget  environment 
[15].  Having  an  adaptable,  fully  autonomous  UAV  platform  would  not  only  allow  for  the 
same  platform  to  be  used  for  various  missions,  but  also  could  allow  for  one  aircraft  to  be 
used  for  all  services.  This  would  save  money  on  the  development  side,  as  well  as  cut 
costs  for  operations  and  maintenance. 

2.  Science,  Civilian,  and  Government  Applications 

UAVs  have  entered  the  mainstream  worldwide,  especially  for  civilian  commercial 
uses  and  scientific  research.  Applications  include  taking  atmospheric  measurements, 
forest  mapping,  weather  prediction,  search  and  rescue,  and  traffic  control,  to  name  a  few. 
A  UAV  has  even  been  used  by  a  team  from  Universite  de  Liege  for  aerial  inventory  of 
elephant  populations  in  Burkina  Faso  [16].  The  market  for  UAVs  for  non-military 
purposes  is  growing  quickly. 

3.  Space  Applications 

Demonstration  of  reliable  autonomous  flight  capability  on  a  robust  earth-based 
platform  is  essential  prior  to  deployment  of  the  technology  in  high-risk  areas  of 
operation,  such  as  on  Mars.  Repairs  are  either  extremely  difficult  or  impossible  in  space, 
and  usually  prohibitively  expensive,  so  autonomous  craft  to  be  used  in  space  must  be 
extensively  tested  and  demonstrated  in  a  local  environment. 

The  research  in  this  work  can  be  applied  to  autonomous  craft  that  could 
eventually  operate  on  the  surface  of  planets,  moons,  and  asteroids,  as  well  as  in  Earth 
orbit  or  deep  space.  The  benefits  are  not  limited  to  atmospheric  aircraft,  as  a  new  model 
can  be  created  or  modified  from  the  current  UAV  model  for  any  environment  and 
vehicle.  The  model  and  autopilot  are  both  adaptable,  while  the  trajectory  generation 
process  remains  the  same  no  matter  the  environment  or  mission  of  the  vehicle. 
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4.  Improvements  for  All  Applications 

A  readily  available  and  easily  adaptable  AAV  platform  that  can  be  given 
commands  and  independently  complete  flight  maneuvers,  such  as  take-off,  landing, 
trimmed  straight-and-level  flight,  coordinated  turns,  smooth  ascents  and  descents,  and 
search  patterns,  and  other  more  exotic  maneuvers  would  remove  the  need  for  a  pilot  with 
specialized  and  lengthy  training.  Whether  the  objective  is  to  lengthen  mission  time, 
reduce  fuel  expenditure,  increase  area  coverage,  or  stretch  on-station  time,  the  same 
platform  could  be  utilized  for  a  variety  of  missions  with  only  minor  modifications  to  the 
problem  formulation  to  account  for  the  new  cost  function,  as  desired. 

As  supercomputers  improve  each  year,  it  may  not  be  long  before  they  achieve 
parity  with  the  human  brain,  and  not  long  after  that  before  smaller  computers  can 
accomplish  the  same  [4].  To  be  truly  autonomous,  a  vehicle  must  have  intelligent 
software  capable  of  autonomously  determining  the  best  way  to  complete  a  high-level 
task.  Solving  a  motion  planning  problem  using  optimal  control  tools  such  as  DIDO  (the 
implementation  of  pseudospectral  optimal  control  theory)  is  one  promising  approach. 
Other  institutions  and  organizations  are  also  exploring  options  such  as  modified 
intelligent  software  agents  [17],  [18],  [19],  [20],  [21],  [22].  These  technological 
advancements  will  make  real-time  optimization  and  intelligent  AAV  systems  achievable 
in  the  future,  and  this  will  open  up  a  whole  range  of  possibilities  for  AAV  missions  and 
design. 

D.  RESEARCH  OBJECTIVES 

This  thesis  addresses  two  main  questions;  first,  whether  the  generated  optimal 
trajectories  can  be  executed  with  the  selected  hardware;  and  second,  how  the  fidelity  of 
the  optimal  control  model  influences  accomplishing  this  task. 

1.  Feasibility  of  Execution  with  Selected  Hardware 

Can  a  specific  fixed-wing,  COTS  RC  aircraft,  fitted  with  a  simple  control  system 
and  low-cost  sensors,  accurately  execute  optimal  trajectories?  This  question  must  be 
answered  first,  in  order  to  move  on  to  the  next  question.  The  aircraft  autopilot  must  be 
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capable  of  taking  the  generated  trajectory  commands  and  successfully  completing 
maneuvers  that  closely  follow  the  desired  trajectory. 

2.  Model  Fidelity  Level 

What  level  of  model  fidelity  is  required  to  generate  trajectories  that  can  be 
reliably  flown?  This  second  question  asks  if  a  lower-fidelity  model  that  makes 
assumptions  to  simplify  conditions  and  inputs  can  create  adequate  trajectories  to  fly  real- 
world  maneuvers.  The  3DOF  model  could  be  a  simplified  point-mass  model,  or  it  could 
include  the  influences  of  control  surfaces  and  flight  dynamics,  i.e.  a  reduced-order 
version  of  the  complex  6DOF  flight  dynamics.  If  it  is  possible  to  fly  trajectories 
generated  with  this  reduced-order  model,  it  will  save  time,  complexity,  and 
computational  cost  over  using  the  full-order  6DOF  model.  This  aspect  is  a  crucial  step 
towards  developing  an  intelligent  autopilot  algorithm  that  can  generate  optimal 
trajectories  in  real  time. 

E.  ORGANIZATION,  METHODOLOGY  AND  SCOPE 

This  thesis  begins  with  a  description  of  the  process  used  to  develop  and  verify  the 
optimal  trajectories  to  answer  the  research  questions  as  stated.  Chapter  II  discusses  the 
selection  and  modeling  of  the  test  aircraft.  Chapter  III  discusses  the  problem  statement 
and  setup,  and  the  step-by-step  development  and  troubleshooting  of  the  problem 
formulation  and  code  in  order  to  produce  a  representative  model  and  feasible  trajectories. 
Chapter  III  also  provides  an  introduction  to  the  tools  utilized  to  create  the  trajectories  and 
solve  the  minimum  time  maneuvering  problem. 

Chapter  IV  presents  a  collection  of  canonical  maneuvers  created  and  simulated  in 
MATLAB  using  DIDO  optimal  control  software,  and  Chapter  V  continues  on  to  describe 
the  trajectory  implementation  environment  including  the  autopilot  system,  simulator,  and 
verification  procedures  of  the  MONARC  optimization  model. 

Chapter  VI  presents  the  results  of  a  more  complex  scenario  aimed  at 
demonstrating  the  application  of  a  typical  canonical  maneuver  for  a  real  aircraft.  In 
particular  the  results  include  a  6DOF  simulation  of  the  mission  scenario  as  well  as  a 
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discussion  of  maneuver  implementation  as  part  of  a  HIL  pre-flight  checkout.  Finally, 
Chapter  VII  discusses  future  work  to  include  physical  flight  tests  and  improvement  of  the 
model  based  on  that  test  data. 

This  work  is  aimed  at  developing  technology  that  can  be  flight-demonstrated; 
however  due  to  a  number  of  regulatory  issues  beyond  the  control  of  the  author,  the  scope 
of  this  work  does  not  include  physical  flight  test  of  the  maneuvers.  Moreover,  only  the 
minimum-time  maneuvering  problem  is  addressed.  Other  objective  functions  are  easy  to 
implement  in  the  presented  framework  but  are  not  studied  here.  Flight  testing  was 
planned  and  an  aircraft  platform  is  flight-ready,  but  due  to  an  unfortunate  accident  with 
an  NPS  unmanned  aerial  system  at  the  local  airfield  during  the  period  of  this  thesis,  all 
NPS  flight  testing  was  put  on  hold  as  of  07  March  2012.  Pursuant  to  this  accident,  a 
NAVAIR  investigation  was  required,  and  all  flight  testing  of  UAVs  involving  NPS 
aircraft  became  subject  to  approval,  stringent  requirements,  and  numerous  prerequisites 
per  OPNAVINST  3750.6,  NAVPGSCOLINST  3700.1,  and  NAVAIR  airworthiness 
standards.  The  required  Naval  Safety  Center  Aviation  Safety  Survey  Checklist  has  been 
completed,  and  a  90-day  waiver  for  flying  the  MONARC  was  granted  on  27  November 
2012.  Unfortunately  this  approval  was  not  granted  with  enough  time  to  allow  for 
scheduling  of  facilities  and  completion  of  initial  checkout  and  flight  testing  before 
completion  of  this  thesis. 

This  thesis  is  part  of  an  ongoing  effort  to  eventually  produce  a  variety  of  vehicles 
that  are  capable  of  truly  autonomous  operations,  using  pseudospectral  motion  planning  as 
a  key  enabling  technology.  The  autopilot  is  currently  being  developed  for  use  with  both  a 
Traxxas  Summit  ground  vehicle  [23]  and  a  Multiplex  Mentor  aircraft  as  described  in 
Chapter  II.  The  autopilot  is  intended  to  eventually  be  readily  adaptable  for  use  in 
multiple  environments  and  vehicles,  including  but  not  limited  to  fixed  wing  aircraft, 
quad-rotor  aircraft,  ground  vehicles,  earth-orbiting  satellites,  and  planetary  aerial 
vehicles. 
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II.  THE  MONARC  AIRCRAFT 


A.  SELECTION  OF  TEST  AIRCRAFT 

1.  Selection  Criteria 

A  variety  of  aircraft  were  considered  as  test  platforms  for  demonstrating 
the  implementation  of  the  designed  canonical  maneuvers.  These  included  a  battery- 
powered  quad-rotor  craft,  gas-powered  kit  model  airplanes,  and  several  other  similar 
fixed-wing,  battery-powered,  COTS  model  aircraft.  It  was  considered  desirable  to  choose 
an  aircraft  that  would  be  transportable  to  the  airfield  inside  a  personal  automobile,  and 
that  the  aircraft  be  battery-powered  rather  than  gas-powered  for  storage  and  transport 
reasons. 

The  Multiplex  Mentor  aircraft  [24]  was  selected  in  part  due  to  its  low  cost,  ready 
availability  for  purchase  from  major  hobby  retail  stores  such  as  Hobby  Warehouse  and 
RC  Planet,  and  its  popularity  as  a  recreational  RC  aircraft — this  meant  that  parts  would 
be  readily  available,  as  well  as  many  forums  with  solutions  to  any  known  issues  with  the 
platform.  Another  reason  the  Mentor  was  selected  is  that  it  has  been  used  for  research  at 
the  other  universities.  Working  with  the  same  platform  will  help  to  facilitate  sharing  of 
data,  information,  and  lessons  learned. 

Four  aircraft  were  purchased,  and  three  constructed:  one  by  fellow  student  Robert 
Casey,  one  by  the  author,  and  one  by  the  safety  pilot  and  NPS  UAV  expert  Dr.  Kevin 
Jones.  The  remaining  kit  was  utilized  for  spare  parts.  The  redundancy  in  test  models 
allows  for  better  and  more  varied  system  identification  data  collection,  and  in  the  future 
will  allow  for  formation  flights  of  multiple  autonomous  vehicles. 

2.  Physical  and  Aerodynamic  Characteristics 

The  Mentor  Optimal-trajectory  Naval  Autonomous  Research  Craft  (MONARC)  is 
built  around  a  modified  Mentor  airframe,  with  equipment  and  airframe  changes  to 
support  an  unmanned  avionics  (autopilot)  system  and  the  associated  sensors. 


11 


Figure  3.  MONARC  Aircraft  with  Views  of  Modified  Fuselage 

Figure  3  shows  one  of  the  MONARC  aircraft  in  its  storage  rack,  and 
close-up  views  of  the  fuselage  modifications  to  accommodate  the  autopilot  board, 
sensors,  and  antenna.  Estimates  of  some  aircraft  performance  parameters  and  constants 
are  in  Table  1.  The  minimum  flight  velocity  is  the  stall  speed,  and  maximum  flight 
velocity  is  the  maximum  dive  velocity  of  the  aircraft,  as  given  by  the  manufacturer  [24], 

[25]  and  obtained  from  a  SIMULINK  model  of  the  aircraft.  Maximum  range  and 
endurance  are  taken  from  the  capability  of  the  motor  and  propeller  used  with  the 
MONARC.  The  aircraft  mass  is  an  average  value  based  on  the  Mentor  airframe  plus 
autopilot  equipment  taken  for  the  three  aircraft.  The  wing  area,  wingspan,  and  center  of 
gravity  were  measured  physically.  The  aerodynamic  coefficients  were  determined  from 
an  existing  SIMULINK  model  and  scaled  down  from  an  aircraft  with  known  coefficients 

[26] ,  [27].  Maximum  and  minimum  thrust  values  were  determined  from  simulations 
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using  the  SIMULINK  model.  All  of  these  values  will  be  used  for  maneuver  generation  in 
this  thesis.  It  is  anticipated,  however,  that  flight  testing  will  provide  more  accurate 
numerical  values. 


MONARC  Aircraft  data  and  constants: 


Parameter 

Symbol 

Value 

Units 

Notes 

Minimum  flight  velocity 

Vmin 

13.9 

m/s 

Aircraft  stall  speed 

Maximum  flight  velocity 

Vmax 

41.  7 

m/s 

Maximum  dive  velocity 

Median  flight  velocity 

Vmed 

27.5 

m/s 

Aircraft  mass 

m 

2 

kg 

Wing  area 

S 

0.982 

mA2 

Length 

- 

1.17 

m 

Wingspan 

- 

1.63 

m 

Center  of  Gravity 

CG 

0.083 

m 

measured  towards  tail  end  from 
wing's  leading  edge  at  fuselage 

Minimum  Thrust 

T  min 

3 

N 

Maximum  Thrust 

Tmax 

35 

N 

Maximum  Flight  Endurance 

- 

45 

min 

Maximum  Range 

- 

13 

km 

Range  vs.  Altitude  (glide 
capability) 

500/100 

m 

500  m  horizontal  travel  per  100  m 
vertical  drop 

Table  1.  Estimated  MONARC  Aircraft  Physical  and  Performance  Parameters 


3.  Assembly 

Each  aircraft  was  assembled  according  to  the  manufacturer’s  kit  directions  [25], 
and  then  modified  in  order  to  integrate  the  autopilot  and  supporting  hardware.  The 
airframe  modifications  included  removal  of  small  sections  of  fuselage  and  wing  to  make 
room  for  the  autopilot  board  and  its  peripherals  such  as  the  antenna,  wiring,  Pitot  tube, 
GPS,  and  other  attached  instruments. 
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The  aircraft  can  be  flown  in  manual  mode,  using  a  conventional  RC  control,  or  it 
can  be  controlled  using  the  control  logic  of  the  autopilot.  There  is  also  a  HIL  mode  that 
allows  the  autopilot  hardware  to  be  driven  using  simulated  sensor  inputs  derived  from  a 
6DOF  aircraft  model. 

B.  MODELING  THE  MONARC  AIRCRAFT 

A  preliminary  model  of  the  MONARC  aircraft  was  created  in  order  to  generate 
trajectories  that  could  be  flown  by  the  actual  aircraft.  The  model  characteristics  were 
determined  from  measurement  of  physical  parameters  on  actual  flight  hardware,  as  well 
as  from  computer  simulation  or  estimates  based  on  best  engineering  judgment. 

1.  The  6DOF  Dynamics  Model 

A  full  dynamic  model  of  an  aircraft  considers  all  six  degrees  of  freedom  for  the 
aircraft  motion,  and  has  twelve  states  with  a  reasonably  high  level  of  calculation 
complexity. 


a.  Reference  Frame 

The  6DOF  model  uses  a  flat-Earth  NED  reference  frame  for  position,  and 
body-axes  reference  frame  for  all  other  states,  as  shown  in  Figures  4  and  5. 


■ 


Figure  4.  Body-Axis  Coordinate  System 
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V 


Figure  5.  6D0F  Longitudinal  and  Directional  Flight  Angles  (After  [28]) 
b.  Equations  of  Motion 

The  6DOF  equations  of  motion  are  functions  of  states,  forces,  moments, 
and  velocity  components  as  shown  in  Table  2. 


Roll  (x-axis) 

Pitch  (y-axis) 

Yaw  (z-axis) 

Angular  Rates 

P 

q 

r 

Velocity  Components 

u 

V 

w 

Aerodynamic  Force  Components 

X 

Y 

Z 

Aerodynamic  Moment  Components 

L 

M 

N 

MOI  about  each  axis 

lx 

iy 

Iz 

Table  2.  6DOF  Forces,  Moments,  and  Velocity  Components  (After  [28]) 


The  aerodynamic  forces  and  moments  on  the  aircraft  in  this  model  are  listed  in 
Table  3,  and  the  twelve  states  for  the  6DOF  model  are  listed  in  Table  4. 

The  6DOF  model  is  a  nonlinear  model  in  the  Flat-Earth,  Body-Axes  reference 
frame.  The  standard  6DOF  equations  of  motion  from  [28],  [30]  include  the  position 
Equations  (2.1),  the  control  rate  Equations  (2.2),  the  angular  velocity  Equations  (2.3),  the 
Euler  angle  rate  Equations  (2.4),  and  the  force  and  moment  Equations  (2.5). 
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Aerodynamic  Forces  and  Moments 

X 

Axial  Force 

Y 

Side  Force 

Z 

Normal  Force 

L 

Rolling  Moment 

M 

Pitching  Moment 

N 

Yawing  Moment 

Table  3.  6D0F  Aerodynamic  Forces  and  Moments 


6DOF  Aircraft  States: 


Name 

symbol 

units 

Velocity 

V 

m/s 

Angle  of  Attack 

a 

rad 

Sideslip  Angle 

P 

rad 

Roll  rate 

P 

rad/s 

Pitch  rate 

q 

rad/s 

Yaw  rate 

r 

rad/s 

Roll  angle 

rad 

Pitch  angle 

e 

rad 

Yaw  Angle 

rad 

X-coordinate  (Earth  Axes) 

Xe 

m 

Y-coordinate  (Earth  Axes) 

Ye 

m 

Altitude 

z 

m 

Table  4.  6DOF  Aircraft  States  (After  [28,  29]) 


Position  equations  for  the  nonlinear  6DOF  model  are  given  in  the  earth- 
reference  frame  as: 

xe  =  [cos  6  cos  y/W  cos  a  cos  /?  +  [sin  (/>  sin  6  cos  y/  -  cos  (j)  sin  y / ]V  sin  / 3 
+  [sin  (f)  sin  y/  +  cos  (f)  sin  6  cos  y/]V  sin  a  cos  /? 

ye  =  [cos  6  sin  y/'JV  cos  a  cos  /?  +  [cos  (j) cos  y/  +  sin  (j)  sin  6  sin  y/'JV  sin  f3 

(2. 1) 

+  [cos  (j)  sin  6  sin  y/  -  sin  (f)  cos  ^]V  sin  a  cos  ft 

ze  =  [-  sin  0]V  cos  a  cos  y 3  +  [sin  (f)  cos  6*]V  sin  p 
+  [cos  (f)  sin  0]V  sin  a  cos  ft 
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While  the  6D0F  control  rate,  angular  velocity,  Euler  angle  rate  equations, 
and  force  and  moment  equations  are  given  in  the  body-reference  frame  as: 


V  =  [ - g  sin  9 ]  cos  a  cos  /?  +  [ — b  g  sin  (/>  cos  9 ]  sin  /? 

in  m 

Z 

+  [—  +  g  cos  ^  cos  sin  a  cos  /? 
m 


1  g 

a  = - [Zcosa-X  sincrlH - [cos  6  cos  9  cos  a  +  sin  9  sin  a] 

mV  cos  /3  Vcos/?  (2.2) 

+  q  -  tan  J3[  p  cos  a  +  r  sin  a] 


P 


cos  /? 


mV 
sin  /? 
mV 


[F  +  mg  sin  ^  cos  #]  +  p  sin  a  -  r  cos  a 


o  R 

[Z  sin  a  +  X  cos  a] - [cos  (f>  cos  9  sin  a 


sin  6  cos  a] 


P  J  J  J  2  (I Z7,  1yy)CP  +  I Xz9P\ 

•*  XX  *  ZZ  —  *  xz 

+  2lN  +  (la -l„)qP-l„qr\ 

*xx*zz  *xz 

4  =  ~~[M  -(/ H  -Izz)pr-Ixz(p2  -r2)]  (2.3) 

iyy 

f  —  —  -  j  \L  +  (Iyy  —  Izz  )qr  + 1 xzqp] 

*  xx*zz  ~  *xz 

+  —  ~  ~  2  (I XX  —  I YY  —  !XZCP  ] 

*XX*ZZ  —*XZ 


(j)  -  p  +  (q  sin  (j)  +  r  cos  <fi)  tan  6 

9  -  q  cos  (j)-r  sin^  (2.4) 

\j/  -  (q  sin  (j)  +  r  cos  <j>)  sec  9 
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The  forces  and  moments  depend  on  the  aircraft  configuration  and  flight 
requirements  are  computed  from 

X  =  \p{z)V2SrefCx{a,p,M,S)  +  Tx 
2 

Y  =  ^p(z)V2SrefCY(jB,M,S)  +  Ty 

Z  =  ^p(z)V2SrefCz(a,fJ,M,S)+Tz 

L  =  \p(z)V2SrefbCl(jB,M,S) 

2 

M  =\p(z)V2Sref~cCm(a,pM,8) 

2 

N='-p(z)V1Sr,[bC„(P.M.T.5) 

2  (2.5) 

The  6DOF  model  is  prohibitively  complex  for  solving  the  optimization  problem 
in  a  timely  manner  [28].  One  very  recent  way  that  has  been  used  to  get  around  this 
problem  is  to  use  a  3DOF  solution  as  a  bootstrap  to  the  6DOF  problem  [31].  This  thesis 
takes  the  approach  of  creating  a  model  that  is  of  higher  fidelity  than  the  simplified  3DOF 
point  mass  problem,  but  that  is  less  complex  than  the  full-order  6DOF  model.  As  will  be 
seen  the  fidelity  of  the  3DOF  model  is  sufficient  for  flight  implementation. 

2.  SIMULINK  Flight  Control  Toolbox  Model 

The  FDC  toolbox  in  SIMULINK  contains  a  full  model  of  a  6DOF  De  Havilland 
Beaver  aircraft,  complete  with  autopilot  functions  and  flight-verified  aerodynamic 
coefficients,  Mol,  and  performance  characteristics  [26].  This  model  was  scaled  down  and 
modified  into  a  model  of  the  Mentor  by  Dr.  K.  Lee  [27],  utilizing  performance  criteria 
and  physical  characteristics  of  the  Mentor  aircraft,  either  estimated  or  measured  from 
testing  of  the  MONARC.  Actual  flight  data  will  be  used  later  to  iteratively  upgrade  the 
model.  The  procedure  used  to  develop  and  test  the  model  is  compared  with  the  general 
procedure  for  traditional  full-scale  aircraft  testing  in  Figure  6. 
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Figure  6.  Procedures  for  Aircraft  Modeling  (From  [27]) 


The  model  was  scaled  down  using  the  SIMULINK  FDC  Toolbox  version  1.4,  and 
the  initial  modifications  to  the  Beaver  model  included  adjusting  to  the  Mentor’s  weight 
and  CG,  and  scaling  down  the  wing  characteristics  to  those  of  the  Mentor  [27].  The 
aerodynamic  characteristics  were  modified  using  computer  simulation  test  data. 

To  determine  the  moments  of  inertia  of  the  aircraft,  a  swing  test  was  performed 
using  the  MONARC  aircraft  and  the  autopilot  onboard  sensors.  The  data  collected  was 
incorporated  with  the  SIMULINK  model.  A  photo  of  the  pendulum  test  apparatus  in  the 
lab  is  shown  in  Figure  7. 
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Figure  7.  Mol  Test  Apparatus 
a.  SIMULINK  Model 

The  SIMULINK  model  serves  a  computer  simulation  platform  for 
implementation  of  the  desired  maneuver  trajectories  to  show  whether  the  trajectory  is 
flight-feasible  for  the  subject  aircraft.  The  model  is  also  utilized  for  trajectory  comparison 
of  optimized  maneuvers  versus  the  trajectory  flown  by  a  more  traditional  autopilot 
control  system.  The  structure  of  the  SIMULINK  model  Control  Law  Structure  is  shown 
in  Figure  8,  and  the  full  model  with  input  and  output  definitions  is  shown  in  Figure  9. 
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Figure  8.  SIMULINK  Model  Control  Law  Structure  (From  [27]) 


Mentor 


Figure  9.  MONARC  SIMULINK  Model— Highest  Level  View  (From  [27]) 


b.  Aerodynamic  Coefficients 

As  mentioned,  the  aircraft’s  aerodynamic  coefficients  were  determined  by 
scaling  down  an  existing  aircraft  model  with  a  similar  configuration.  The  6DOF 
aerodynamic  coefficients  used  for  all  trajectories  generated  in  this  thesis  are  listed  in 
Table  5. 
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CXO 

-0.03554; 

CZO 

= 

-0.05504;  CmO 

= 

0.09448; 

CXa 

0.002920; 

CZa 

= 

-5.578;  Cma 

= 

-0 . 6028; 

CXa2  = 

5.459; 

CZa3 

= 

3.442;  Cma2 

= 

-2 . 140; 

CXa3  = 

-5.162; 

CZq 

= 

-2.988;  Cmq 

= 

-15.56; 

CXq 

-0 . 6748; 

CZde 

= 

-0.3980;  Cmde 

= 

-1 . 921; 

CXdr  = 

0.03412; 

CZdeb2 

= 

-15.93;  Cmb2 

= 

0.6921; 

CXdf  = 

-0.09447; 

CZdf 

= 

-1.377;  Cmr 

= 

-0.3118; 

CXadf  = 

1 . 106; 

CZadf 

= 

-1.261;  Cmdf 

= 

0.4072; 

CYO 

-0.002226; 

CIO 

= 

0.0005910;  CnO 

= 

-0.003117; 

CYb 

-0.7678; 

Clb 

= 

-0.06180;  Cnb 

= 

0.006719; 

CYp 

-0 . 1240; 

Clp 

= 

-0.5045;  Cnp 

= 

-0 . 1585; 

CYr 

0.3666; 

Clr 

= 

0.1695;  Cnr 

= 

-0 .1112; 

CYda  = 

-0.02956; 

Clda 

= 

-0.09917;  Cnda 

= 

-0.003872; 

CYdr  = 

0 .1158; 

Cldr 

= 

0.006934;  Cndr 

= 

-0.08265; 

CYdra  = 

0.5238; 

Cldaa 

= 

-0.08269;  Cnq 

= 

0 . 1595; 

CYbdot= 

-0 .1600; 

Cnb3 

= 

0 . 1373; 

Table  5. 

Preliminary  MONARC  Aerodynamic  Coefficients  (From  [32]) 

The  pertinent  coefficients  for  use  in  the  3DOF  optimization  model  are 
CXO,  CZO,  CXa,  and  CZa,  which  are  used  to  calculate  Cl  and  Cd  for  the  model.  The 
aerodynamic  coefficients  will  be  updated  using  actual  flight  data  from  the  system 
identification  flight  tests  when  available,  to  improve  the  fidelity  of  the  model. 

c.  Control  limits 

The  limits  on  inner  loop  control  system  performance  can  be  used  for 
bounds  in  the  optimal  control  problem  to  ensure  that  the  designed  maneuver  can  be 
physically  implemented.  Their  values  were  determined  from  the  SIMULINK  control 
system  model  based  on  the  closed-loop  response  times  of  the  various  inner  loop  control 
systems.  Actual  control  limits  will  be  determined  via  flight  test,  and  incorporated  into  the 
model.  The  thrust  limits  were  estimated  based  on  the  aircraft  size  and  mass  and  the  motor 
specifications.  The  heading  rate  control  limits  are  from  the  SIMULINK  model.  Control 
limits  are  listed  with  the  maneuver  setup  in  Chapter  IV. 
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III.  THE  TRAJECTORY  OPTIMIZATION  PROBLEM  FOR  A 

FIXED-WING  AIRCRAFT 


A.  DESCRIPTION  OF  PROBLEM 

The  desired  outcome  of  the  trajectory  optimizations  in  this  thesis  are  minimum¬ 
time  maneuvers  that  can  be  performed  more  quickly  than  similar  conventional 
maneuvers.  The  optimal  control  solution  could  also  be  performed  for  maximizing  or 
minimizing  a  number  of  other  objectives,  including  fuel  consumption,  time  on  station, 
and  area  covered. 

In  order  to  solve  the  underlying  optimal  control  problem  and  find  the  best 
trajectory  to  perform  a  given  task,  an  optimal  control  software  tool  is  used.  For  all 
maneuvers  in  this  work,  DIDO  pseudospectral  optimal  control  software  was  used. 


B.  THE  OPTIMAL  CONTROL  PROBLEM 

The  generic  optimization  problem  P0  from  [7],  [28],  [33],  [34]  is 

ff 

Minimize  J  [x(«), w(*), tf]  =  E(xf,tf)  + 1 F  (x(t),u(t))dt 

fo 

Subject  to : 
x(t)  =  f(x(t),u(t)) 


(P)\ 


x(t0)  =  x 

t  =t° 

l0  1 

tf  =  tf 

e{x{tf))  =  0 


(3.1) 


Where  J  is  the  cost  functional,  E  is  the  endpoint  cost,  F  is  the  running  cost,  x  is 
the  set  of  state  variables,  x  =  f(x,u )  is  the  set  of  dynamics  equations,  u  is  the  set  of 
control  variables,  and  e  is  the  set  of  endpoint  constraints.  A  set  of  path  constraints,  h(x,u), 
may  also  be  applied  in  some  circumstances.  These  are  not  shown  in  (3.1). 
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The  necessary  conditions  for  optimality  are  given  by  [7],  [28],  [33],  [34] 


M0  = 


-dH 

dx 


dH 

du 


=  0 


Mtf)  = 


-dE 

dxt 


adjoint  equation 


Euler-Lagrange  equation 


transversality  condition 


(3.2) 


where  H  is  the  Hamiltonian  defined  as 


H(/ 1,  x,u )  =  F(x,u)+Ar  f(x,u) 


(3.3) 


and  the  Endpoint  Lagrangian  is 


E(v,  x(tf))  =  E(x(tf  ))  +  vTe(x(tf )) 


(3.4) 


For  the  constrained  dynamic  optimization  problem  the  Euler-Lagrange  equations 
are  not  valid,  so  the  optimal  control  problem  Pqc  must  be  used  instead  [33],  [34] 


( Poc ) 


J 

Minimize  J  [.*(•), u(»), tf]  =  E(x(tf))  +  J F (x(t),u(t))dt 


Subject  to : 

x{t)  =  f{x{t),u(t)) 

x(t0)  =  x° 


t  =t 
'o  ' 


e(xf,tf)  =  0 

uL  <  u(t)  <  uu 


(3.5) 


For  the  optimal  control  problem,  the  control  is  now  bounded,  rather  than  using 
open  sets.  The  Hamiltonian,  adjoint,  and  transversality  conditions  remain  the  same,  but 
instead  of  the  Euler-Lagrange  equations,  the  problem  now  makes  use  of  the  Hamiltonian 
Minimization  Condition  [34] . 
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Minimize  H  (A,  x,  u) 
Subject  to  uL  <u<uu 


(3.6) 


The  value  of  the  minimized  Hamiltonian  is  a  constant  as  a  function  of  time,  and  in 
the  case  of  a  minimum  time  problem  the  value  is  equal  to  a  constant  H(t)  =  -1  [34]. 

C.  CREATING  A  DYNAMIC  MODEL  OF  THE  MONARC  AIRCRAFT 

The  equations  of  motion,  x(t)  =f  (x(t),u(t))  that  are  used  in  the  OCP  formulation 
are  derived  from  standard  6DOF  equations  of  motion  for  an  aircraft,  as  presented  in  [30]. 
The  full  order  6DOF  model  comprises  12  equations  of  motion  (see  Chapter  II)  and  is 
reasonably  complex.  The  complexity  of  the  problem  is  further  increased  with  the  addition 
of  approximated  atmospheric  conditions  and  other  external  effects  on  the  aircraft.  To 
arrive  at  a  suitable  reduced-order  model,  several  iterations  were  performed.  These  are 
elaborated  on  next. 

The  first  step  in  the  early  development  of  the  model  was  to  use  the  most  simple 
3DOF  kinematic  model  possible  to  gain  familiarity  with  the  software,  procedures,  and 
maneuvering  of  the  aircraft.  Next,  the  model  was  upgraded  using  a  more  complex  3DOF 
model  that  was  reduced  from  the  full-order  6DOF  model  but  takes  into  account  values  for 
thrust  and  the  presence  of  actual  aircraft  control  surfaces. 

1.  The  Simple  3DOF  Point-Mass  Model 

The  simple  3DOF  model  assumed  a  point-mass  aircraft.  The  minimum  time 
optimal  control  problem  was  set  up  for  the  simple  3DOF  model  using  the  form  of 
Equation  (3.5)  and  the  state  and  control  variables  listed  in  Tables  6  and  7. 


Control  Name 

symbol 

units 

Acceleration 

Ua 

m/s2 

Pitch  rate  of  change 

UY 

rad/sec 

Heading  rate  of  change 

Ua 

rad/sec 

Table  6.  Controls  for  Point-mass  3DOF  Model 
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State  Name 

symbol 

units 

x-position  (downrange) 

X 

Meters,  m 

y-position  (cross-range) 

y 

Meters,  m 

z-position  (altitude) 

z 

Meters,  m 

Velocity  (airspeed) 

V 

Meters  per  second,  m/s 

Flight  Path  Elevation  Angle 

y 

Radians,  rad 

Flight  Path  Heading  Angle 

a 

Radians,  rad 

Table  7.  States  for  Point-mass  3DOF  Model 


a.  The  Minimum  Time  Problem  Formulation 


For  the  minimum-time  problem,  the  endpoint  cost  is  the  final  time,  zy,  and 
there  is  no  running  cost.  Using  (3.5)  and  a  point-mass  model,  the  minimum  time  optimal 
control  problem  is 


Minimize  J  f]  = 

Subject  to: 

X  =  V  COS  Y  COS  (7 
y  =  v  cos  y  sin  a 
Z  =  v  sin  y 


(P< 


OC  Min.  Time 


) 


v  =  ua 

Y=Uy 


&  =  ua 
x(tQ)  =  X° 
t  =t° 

tg  l 

e(x(tf))  =  0 
u  <\u\<u 

<  I  1 


(3.7) 


b.  Reference  Frame 

The  reference  frame  used  for  the  simplified  3DOF  point  mass  model  is  a 
body-reference  frame  for  flight  angles  and  a  standard  Cartesian  coordinate  system  for  the 
position  states  (see  Figure  10). 
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Heading 

Reference 

A 


Figure  10.  3DOF  Simplified  Point-mass  Model  Flight  Angles 


c.  Disadvantages  of  the  Simplified  Point-Mass  3DOF  Model 

While  the  3DOF  point-mass  model  was  highly  useful  for  familiarization 
and  development  of  the  basic  code,  it  did  not  allow  for  modeling  the  effects  of  control 
surfaces — the  simple  3DOF  model  used  a  point  mass  that  can  only  change  heading, 
velocity,  and  position,  without  taking  into  account  turn  rates,  thrust  control,  or  the  ability 
of  actuators  and  control  surfaces  to  make  turns.  A  higher- fidelity  model  is  required  to 
effectively  model  how  an  aircraft  in  flight  will  actually  behave,  in  order  to  generate 
trajectories  that  may  be  flown  by  a  real  aircraft. 

2.  The  3D  OF  Dynamic  Model 

Using  certain  assumptions,  the  full  6DOF  model  may  be  reduced  to  a  reasonable 
3DOF  approximation.  This  allows  for  enough  fidelity  to  generate  trajectories  that  an 
AAV  may  fly,  but  reduces  the  complexity  of  the  computations  so  that  the  calculations 
may  be  made  in  a  reasonable  amount  of  time,  with  the  eventual  goal  being  to  enable  an 
AAV  to  solve  optimal  trajectories  in  real-time. 
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a. 


Model  Assumptions 


The  assumptions  made  in  order  to  simplify  the  model  are  listed  in  Table  8: 


Model  Assumptions: 

Flat,  non-rotating  Earth 
No  wind 

No  gravity  variations 
No  coriolis  effect 

Rigid  body  vehicle _ 

Constant  mass 

Negligible  cross-products  of  inertia 

Z=0  is  at  sea  level,  standard  atmosphere _ 

Steady,  coordinated  turns  with  no  side-slip 
Table  8.  3DOF  Model  Assumptions 

b.  3DOF  Dynamics 

A  3DOF  dynamics  model  with  side-slip  and  thrust  consists  of  the 
following  dynamic  equations  [28]: 

x  -  vcos/coser 
y  =  v  cos  y  sin  a 
z  =  v  sin  / 

v  =  —  (-D  cos  (3  +  Y  sin  (3  +  T  cos  [3  cos  a)-g  sin  y 
m 

Y  =  -^—(-D  sin  (3 si  ju-Y  sin  //cos  /3  +  L cos  //  (3  8) 

fflV 

Q 

+  T( cos  //sina  +  sin  //sin  /3 cos  a)) - cos  y 

v 

&  = - - - ( D  sin  / 3  cos  ju  +  Y  cos  //  cos  (3  +  L  sin  // 

mv  cos  y 

+  T (sin  ju  sin  a  -  cos  //  sin  cos  a) 

This  set  of  equations  is  clearly  of  significantly  greater  complexity  than  the 
point  mass  model  (3.7)  and  allows  for  simulation  of  control  surfaces.  At  the  same  time  it 
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is  reduced  enough  in  complexity  from  the  6DOF  model  that  it  could  eventually  allow  for 
real-time  optimization. 


c.  Aerodynamics  and  Atmospheric  Conditions 

The  model  uses  standard  atmospheric  conditions,  which  vary  by  altitude. 
A  basic  air  density  estimation  equation  is  used 

p  =  \.2\e~zimx>  (kg/m3)  (3.9) 


Figure  11.  Relationship  between  Aerodynamic  Coefficients  when  [>=()  (After  [28]) 


The  aerodynamic  coefficients  Cz  and  Cx  are  converted  to  Cl  and  Cd  for 
use  in  the  lift  and  drag  equations  (see  Figure  11): 


CL  =  -Cx  sin  a  +  C_  cos  a  (3.10) 

CD  =  —Cx  cos  a  +  C.  sin  a  (3.11) 


The  lift  and  drag  equations  are  used  to  calculate  L  and  D  values  for  the 
dynamics  equations 


L=X-pV2SCL 
D  =  ^pV2SCD 


(3.12) 

(3.13) 


29 


d.  Final  3DOF  Dynamic  Model 

In  order  to  further  reduce  the  complexity  of  the  model,  several 
assumptions  are  made  in  addition  to  those  from  Table  8.  It  is  also  assumed  that  all  turns 
are  perfectly  coordinated,  with  no  side-slip.  In  the  absence  of  side-slip,  fS  and  /?  are  equal 
to  zero,  causing  all  terms  containing  [1  to  drop  out  and  reducing  the  equations  in  (3.8)  as 
follows: 

x  =  v  cos  y  cos  a 
y  =  v  cos  y  sin  a 
z  =  v  sin  y 

v  —  —  (-D  +  T  cos  a)-g  sin  y 

m  (3.14) 

1  g 

y  =  —  ( Lcos/j  +  T  cos /j  sin  a) - cos  y 

mv  v 

&  = - - - (L  sin  n  +  T  sin  fj,  sin  a) 

mv cos  y 

Since  the  aircraft  will  be  under  control  of  an  autopilot,  which  implements 
inner  loop  control  logic,  the  control  variables  are  taken  as 

T  =  uT 

a=ua  (3.15) 

M  = 

This  enables  the  optimal  control  solution  to  accommodate  inner-loop  time  constants. 

Nine  states  for  the  aircraft  are  described  by  the  reduced-order  dynamic 
model  (see  Table  9),  rather  than  the  twelve  states  of  the  full-order  model  or  six  states  of 
the  more  simplified  3DOF  model.  In  addition  to  position  and  velocity,  the  states  also 
include  Thrust  and  four  angles:  flight  path  elevation  angle,  which  is  the  angle  between 
the  x-y  plane  and  the  nose  of  the  aircraft;  the  flight  path  heading  angle,  which  is  the 
direction  the  aircraft  is  pointed  in;  the  angle  of  attack,  which  is  the  angle  between  the 
relative  wind  and  nose  of  the  aircraft,  or  in  other  words  the  pitch  of  the  aircraft;  and  the 
bank  angle  of  the  aircraft,  which  combines  the  elements  of  yaw  and  roll. 
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State 

symbol 

units 

x-position  (downrange) 

X 

Meters,  m 

y-position  (cross-range) 

y 

Meters,  m 

z-position  (altitude) 

z 

Meters,  m 

Velocity  (airspeed) 

V 

Meters  per  second,  m/s 

Flight  Path  Elevation  Angle 

y 

Radians,  rad 

Flight  Path  Heading  Angle 

a 

Radians,  rad 

Thrust 

T 

Newtons,  N 

Angle  of  Attack 

a 

Radians,  rad 

Flight  Path  Bank  Angle 

F 

Radians,  rad 

Table  9.  Reduced-Order  3DOF  Model  States 


The  reduced-order  model  controls  are  then: 


Control  Name 

symbol 

units 

Thrust  rate  of  change 

Up 

N/sec 

AoA  rate  of  change 

Ua 

rad/sec 

BA  rate  of  change 

JU _ 

rad/sec 

Table  10.  Reduced-order  3DOF  Controls 


e.  Minimum  Time  Problem  Formulation 

Using  (3.5),  (3.14),  and  (3.15)  along  with  Tables  9  and  10,  the  minimum 
time  problem  for  the  reduced-order  3DOF  model  is 
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Minimize  J  [y(»),u(»),tf  ]  =  tf 
Subject  to: 
x  =  v  cos  y  cos  a 
y  =  v  cos  y  sin  a 
i  =  vsin^ 

v  =  —  (-D  +  T  cos  a)  -  g  sin  y 
m 

1  9 

y  =  — (L  cos  ju  +  T  cos  //sin  a) - cos^ 

mv  v 


(Pc 


oc , 


) 


1 


a  = - 

mv  cos  y 

T  —  uT 

a  =  u„ 


■  (L  sin  /j  +  T  sin  //  sin  a) 


A  =  ufJ 

-  -0 
x(tQ)  =  X 


t 


0 


=  t 


0 


e(x(tf))  =  0 


L  <\  \  <  U 

Icf/rji  -  I  l/t 'J-'  I  1/Crjf 

u  L  <\u  I  <u  u 

a  |  a  |  a 


L  / 


<  u, 


(3.16) 


/.  Analysis  of  the  OCP 

Applying  the  procedure  from  equations  (3.2)  through  (3.7)  and  (3.10), 
analysis  of  the  optimal  control  problem  in  this  case  begins  with  formulation  of  the 
necessary  conditions  for  optimality.  Using  (3.3)  to  formulate  the  Hamiltonian  for  this 
problem,  the  running  cost  term  can  be  eliminated  as  there  is  only  an  end  cost  in  this  case, 
and  the  Hamiltonian  is  then 
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H(A,x,u )  =  Ax  [v  cos  y  cos  cr]  +  2v  [v cos y  sin  a]  +  A_  [vsiny] 


+2, 


+  2„ 


+2„ 


—  ( -D  +  T  cos  a)  -g  sin  y 
m 


1  p 

—  (Lcos  jU  +  T cos  //sin  a) - cos  y 

mv  v 


1 


mv  cos  y 
+  Aj-Uj  +  Aaua  +  A  u 


(Lsin  //  +  Tsin  //sin  a) 


(3.17) 


M  M 


The  Euler-Lagrange  equation  using  this  new  Hamiltonian  and  following 
the  form  of  (3.2)  the  Euler-Lagrange  equation  for  this  problem  gives 


0 

duT 

dUa 

d--h=* 

du„ 


(3.18) 


applied. 


Since  the  control  variables  do  not  appear  explicitly  in  (3.18),  the  HMC  is 


f  Minimize 
(HMC)  \ 

[  Subject  To 


H(A,x,u ) 
uL  <u<uL 


(3.19) 


Thus  (3.18)  are  interpreted  as  switching  functions.  For  example, 

S ' rp  A^-  ^  ^  0  //y  mm 

Aj,  <  0 

At=  0 


UT  UTm  gx 


UTmm  ~  UT  ~  UTnmx 


(3.20) 


A  similar  interpretation  can  be  made  regarding  the  switching  function  for 
the  other  two  control  variables. 

Assuming  p  is  constant,  the  adjoint  equation,  including  (3.10)  through 
(3.13)  is  formulated  as 
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i(0=^n 

ox 


l(t)  =  —  =  0 


Kit)-- 


K«y 

Kit) 


dy 

-dH 

dx 

-dH 

dz 

-dH 

~dK 


=  0 
=  0 

=  Ax  cos  y  cos  a  +  Av  cos  y  sin  u  +  A,  sin  y 


+  A, 


+  4, 


+1 


—  pvSCD 
m 


11  T  g 

— ( —  pSCL  cos  //  + — cos  //sin  or)  — ^cos  y 
m  2  v“  v 


1  1  T 

- ( —  pSCL  sin  //  +  —  sin  //  sin  or) 

m  cos  y  2  v 


\(t) 


Kit) 

Kit)- 

Kit) 


-dH 

dy 


-dH 

d<7 

-dH 

dT 

-dH 

da 


=  Xx  (' v  sin  y  cos  a)  +  Xv  (v  sin  y  sin  a)  -  A, 


e  . 

v  cos  y  +  g  cos  y - sin  y 

Y 


+  A„ 


1 


: —  (L  sin  ju  +  T  sin  ju  sin  or) 


mV  sin  y 

=  Ax(v  cos  y  sin  a)  -  A  (v  cos  y  cos  a) 
=  -A, 


=  -A- 

m 


“  1 

“  i  . 

l  .  . 

—  cos  or 

~K 

—  cos //sin  or 

~K 

- sin  /u  sin  or 

m 

mv 

mv  cos  y 

1  , 

-  —  /7V  S(CX  sin  a  +  C_  cos  or)  -  T  sin  or 


mv 


■A. 


1  , 

—  p\  S(-Cx  cos  a  -Cz  sin  or)  cos  ju  +  T  cos  //cos  or 

i  n 


—  pv2S(-Cx  cos  or  -  C_  sin  or)  cos  ju  +  T  sin  //cos  or 
mv  cos  y  \_2 


—  (L  sin  //  +  T  sin  //  sin  or) 
mv 


-2 


1 


mv  cos  y 


-{Lcos/u  +  T  cos //sin  or) 


(3.21) 
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From  (3.21)  it  can  be  seen  costates  for  x,  y,  and  z  must  be  constant,  and 
that  no  information  the  remaining  costates  can  be  predicted.  These  results  can  be  used  to 
test  the  optimality  of  the  optimal  control  solution.  Analysis  of  the  transversality 
condition  provides  no  additional  information  that  can  be  used  to  verify  optimality  of  a 
numerical  solution  to  the  OCP. 

g.  Reference  Frame 

The  optimization  model  utilizes  a  flat-Earth  reference  frame,  with  position 
described  in  x-y-z  Cartesian  coordinates  with  respect  to  an  arbitrary  point  on  the  flat 
Earth.  Downrange  distance  is  measured  in  the  x-direction,  cross-range  distance  in  the  y- 
direction  and  altitude  is  measured  up  in  the  z-direction  (see  Figure  12). 


+Y 


+X 

Oc 


Figure  12.  Reference  Frame  for  3DOF  Maneuvers 
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D.  INTRODUCTION  TO  OPTIMAL  CONTROL  WITH  MATLAB  AND 

DIDO 

DIDO  is  a  MATLAB  application  developed  in  1998  as  a  tool  for  solving  complex 
optimal  control  problems  [35].  The  user  must  formulate  the  problem,  within  a  specific 
format,  and  DIDO  uses  a  unique  pseudospectral  optimal  control  theory  approach  to  find 
candidate  optimal  solutions  [35].  It  is  not  a  direct  method,  but  requires  verification  and 
validation  by  the  user  to  ensure  the  optimality  of  the  solution  found.  A  more  thorough 
discussion  of  the  mathematics  and  theory  behind  DIDO  is  beyond  the  scope  of  this  work, 
but  interested  readers  can  find  the  details  in  [8]  and  the  references  therein. 

1.  MATLAB  Optimization  Code 

DIDO  requires  the  user  to  state  the  problem  to  be  optimized  in  a  specific  format. 
Some  of  the  user-supplied  m-files  are  mandatory  for  every  problem,  and  some  are 
optional.  The  mandatory  files  are  the  cost  function,  event  function,  and  dynamics 
function.  The  optional  file  is  the  path  function.  DIDO  allows  for  setup  of  the 
optimization  problem  in  the  form  of  (3.1)  or  (3.8)  that  can  be  readily  adapted  or  changed 
as  needed. 

2.  State  Variable  Constraints 

For  each  state  variable,  box  constraints  must  be  placed.  These  must  be  large 
enough  to  allow  a  feasible  solution  to  be  found  within  the  limits,  but  restrictive  enough 
that  DIDO  will  not  have  to  search  an  unreasonable  range  for  a  solution.  The  state  variable 
limits  are  part  of  the  main  problem  script,  as  the  state  bounds. 

In  the  case  of  the  time-optimized  trajectories,  the  x-  and  y-limits  are  based  on 
leaving  enough  room  for  a  maneuver  to  be  completed,  and  the  z-limit  ranges  from  sea 
level  to  the  service  ceiling  of  the  aircraft.  The  velocity  limits  are  set  by  the  stall  speed  and 
maximum  dive  speed  of  the  aircraft,  and  the  heading  range  is  —n  to  n,  or  360  degrees.  The 
thrust  limit  is  based  on  the  engine  capability,  and  the  maximum  and  minimum  pitch  and 
bank  angle  limits  are  based  off  standard  limits  for  small  RPV  flight.  Representative 
limits  are  listed  in  Table  11. 
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3. 


Initial  and  Final  Conditions 


The  model  is  provided  with  initial  and  final  conditions  for  all  states  or  a  subset  of 
states.  These  may  be  set  at  a  certain  value  or  within  a  range  of  values. 


symbol 

units 

Lower 

Limit 

Upper  Limit 

Notes 

X 

m 

-1.000 

1.000 

representative  example  of  box  limits 

y 

m 

-1.000 

1.000 

representative  example  of  box  limits 

z 

m 

0 

1.000 

estimated  service  ceiling 

V 

m/s 

13 

42 

stall  speed  and  max  dive  speed 

Y 

rad 

-71  /6 

71  /6 

best  engineering  estimate  based  on  SIMULINK 
model 

a 

rad 

-71 

n 

full  circle 

T 

N 

3 

35 

from  SIMULINK  model 

a 

rad 

-71/12 

-71/12 

best  engineering  estimate  based  on  SIMULINK 
model 

M 

deg 

-25 

25 

constraint  from  safety  pilot 

lly 

N/s 

-1 

1 

best  engineering  estimate  based  on  SIMULINK 
model 

Ua 

rad /  s 

-0.05 

0.05 

best  engineering  estimate  based  on  SIMULINK 
model 

Hu _ 

rad/  s 

-0.05 

0.05 

best  engineering  estimate  based  on  SIMULINK 
model 

Table  11.  Representative  Limits  for  States  and  Controls 


4.  Control  Rate  Limits 

The  limits  on  controls  are  set  just  as  the  state  variable  constraints  are.  For  the 
minimum-time  problem  for  the  optimization  model,  the  control  limits  are  set  by  the  time 
constants  of  the  inner  loops  for  thrust  rate  and  turn  rate,  and  derived  from  the  maximum 
load  factor  for  the  AoA  rate.  These  are  coded  in  the  problem  formulation  as  the  control 
bounds  and  shown  in  Table  11. 

5.  Events  Function  and  Limits 

The  events  function  is  a  separate  file  that  describes  the  equations  of  the  endpoints 
of  the  OCP.  The  event  bounds  can  restrict  all  or  none  of  the  states  at  the  endpoints  to  a  set 
value  or  equation,  or  to  a  range  of  values,  depending  on  what  the  desired  endpoint 
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conditions  are.  Similarly,  if  used,  the  path  function  may  restrict  any  or  all  of  the  states  or 
controls  to  a  value  or  range  of  values  for  the  trajectory. 

6.  Time  and  Node  Number  Selection 

A  starting  and  ending  time  range  is  also  required  for  DIDO.  For  the  optimization 
model,  all  maneuvers  used  a  starting  time  of  zero,  and  a  maximum  final  time  of 
100  seconds,  which  was  later  reduced  as  much  as  possible  for  maneuvers  that  took 
significantly  less  than  100  seconds,  to  reduce  run  time. 

Node  numbers  are  set  low  for  initial  DIDO  solution  runs,  and  then  increased  once 
the  code  is  debugged  and  extremal  solutions  are  being  generated.  Normally  it  is  desirable 
to  increase  the  node  number  to  improve  accuracy  as  long  as  this  does  not  make  the 
computation  time  prohibitively  long. 

7.  Maneuver  Results,  Validation  and  Verification 

The  results  generated  by  DIDO  for  the  OCP  include  the  states,  costates,  controls, 
Hamiltonian  value,  and  cost.  The  controls  and  states  make  up  the  trajectory  information 
that  can  be  exported  and  used  for  the  aircraft  to  fly.  The  cost  is  the  time  at  completion  of 
the  maneuver.  For  the  minimum  time  problem  the  numerical  value  of  the  Hamiltonian 
should  be  very  close  to  negative  one  [34] . 

To  verify  that  the  solution  in  each  case  was  both  feasible  and  optimal,  the 
solution  is  verified  via  propagation  and  the  costates  and  Hamiltonian  checked  against  the 
necessary  conditions  per  (3.18)  through  (3.21).  The  aircraft  equations  of  motion  were 
propagated  with  the  controls  via  an  ODE  solver  in  MATLAB.  Depending  on  the 
maneuver,  the  interpl  or  pchip  MATLAB  interpolation  functions  were  used  to  interpolate 
the  optimal  control  history.  Different  interpolation  functions  provided  the  best 
interpolation  fit  and  propagated  solution,  so  several  interpolation  functions  were  tested 
for  each  maneuver  to  provide  the  best  propagation  possible. 

The  propagated  solution  is  compared  with  the  states  from  the  DIDO 
solution  to  determine  if  the  propagated  solution  is  within  an  acceptable  allowance, 
showing  that  the  solution  is  feasible.  The  solution  shown  in  Figure  13  illustrates  a 
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successful  feasibility  propagation,  in  which  the  propagated  solution  converges  with  the 
DIDO-generated  solution,  as  well  as  an  unsuccessful  feasibility  propagation  for 
comparison. 


Sample  Altitude  Propagation 


Figure  13.  Successful  Feasibility  Test  via  Propagation 

8.  Improvements 

a.  Number  of  Nodes 

Increasing  the  number  of  nodes  can  increase  the  fidelity  of  the  results. 
This  can  unfortunately  also  greatly  increase  the  computation  time  required  for  DIDO  to 
find  a  solution.  One  way  to  accomplish  a  node  increase  more  efficiently  is  to 
‘“bootstrap,”4  or  to  feed  the  solution  from  a  lower  node  count  run  into  DIDO  as  the 
“guess”  solution  for  a  higher  node  count  run.  This  can  be  repeated  several  times  in  a  row. 
For  example,  for  most  solutions  in  this  work,  a  12-node  solution  was  found  first.  The  12- 
node  solution  was  used  as  the  initial  guess  for  the  24-node  run,  and  that  result  was  used 
for  the  36-node  calculation,  and  so  on. 

b.  Scaling 

Using  designer  units  to  scale  the  problem  also  reduces  the  run  time  and 
improves  the  DIDO  results  [35].  Scaling,  so  as  to  make  the  state  variables,  control 
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variables  and  costates  within  at  least  an  order  of  magnitude  of  each  other,  or  preferably 
close  to  one,  improves  the  performance. 

E.  TESTING  THE  OPTIMAL  CONTROL  CODE 

The  DIDO  optimization  model  combines  the  dynamics  equations,  states,  and 
controls  from  the  reduced-order  3DOF  model  and  the  physical  characteristics  of  the 
MONARC  aircraft  with  the  time-optimization  problem  format  and  basic  DIDO  codes  to 
form  a  model  for  optimizing  MONARC  trajectories.  It  is  a  flexible  model  that  can  be 
iteratively  upgraded  and  as  flight  data  is  recorded,  and  can  be  optimized  for  a  variety  of 
costs  while  being  used  for  maneuvers  ranging  from  simple  straight-and-level  flight  to 
complex  patterns. 

1.  Code  Verification 

To  verify  and  troubleshoot  the  dynamics  equations,  trajectory  optimizations  were 
performed  using  boundary  conditions  and  control  limits  for  a  known  aircraft 
configuration,  as  given  in  [30] .  This  allowed  for  troubleshooting  to  ensure  that  early  code 
issues  were  not  being  caused  by  incorrect  estimations  of  the  MONARC  aircraft’s  control 
or  state  limits. 

2.  Trim  Maneuvers  and  Additional  Model  Verification 

The  first  maneuvers  obtained  using  the  optimal  control  formulation  were  trim 
maneuvers,  including  straight-and-level  flight,  a  steady  turn,  a  steady  climb,  and  a  turn 
while  climbing.  While  these  are  not  maneuvers  per  se ,  they  allowed  for  further 
troubleshooting,  and  allowed  for  implementation  of  the  trimmed  flight  conditions  at  the 
start  and  end  of  future  maneuvers,  simulating  a  return  to  straight-and-level  that  can  be 
executed  by  the  autopilot  between  optimized  maneuvers.  In  order  to  verify  that  the  model 
can  be  used  for  other  optimization  problems,  OCPs  were  also  generated  and  solved  for 
maximizing  altitude  increase  within  an  area,  and  minimizing  distance  to  climb,  and 
compared  with  a  problem  of  minimizing  time  to  climb. 
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IV.  CANONICAL  MANEUVERS 


A.  FORMULATION  OF  FLIGHT  TEST  MANEUVERS 

Current  microcontroller  technology  has  not  yet  reached  the  level  of  computational 
capacity  and  speed  where  real-time  optimization  is  feasible  for  an  onboard  autopilot  on  a 
small  aircraft  such  as  the  MONARC.  This  does  not  prohibit  optimization  for  autonomous 
vehicles,  but  rather  suggests  the  use  of  an  onboard  database  of  already-optimized 
maneuvers  that  the  autopilot  may  select  from  and  fit  together  to  perform  a  commanded 
task.  A  series  of  time-optimized  canonical  maneuvers  was  selected  and  optimized  in 
order  to  begin  such  a  database  as  well  as  to  test  the  model.  The  maneuvers  were  chosen 
to  demonstrate  a  variety  of  different  flight  conditions  and  state  changes  while 
highlighting  the  features  of  optimal  solutions  for  maneuvers  that  are  commonly 
performed  by  aircraft  on  a  broad  range  of  missions.  Four  typical  maneuvers  of  varied 
complexity  show  how  optimal  trajectories  can  be  generated  for  a  variety  of  situations. 

1.  Conditions  Common  to  Each  of  the  Canonical  Maneuvers 

Each  of  the  canonical  maneuvers  begins  and  ends  with  the  aircraft  in  trimmed, 
straight-and-level  flight,  where  the  AoA  and  Thrust  values  are  calculated  for  this  trim, 
and  the  bank  angle  rate  of  change  is  zero.  The  aircraft  begins  each  canonical  maneuver  at 
the  median  velocity,  and  the  ending  velocity  is  left  free,  which  allows  the  maneuver  to 
end  back  at  the  straight  and  level  Thrust  and  AoA  level  trim  values. 

The  initial  and  final  conditions,  state,  time,  control,  and  event  bounds  applied  to 
all  of  the  canonical  maneuvers  are  listed  along  with  each  maneuver.  Some  bounds  will 
vary,  such  as  those  on  x,  y,  and  z,  depending  on  how  much  room  is  allotted  to  complete 
the  maneuver.  Other  bounds,  such  as  limits  on  controls,  thrust,  and  velocity,  do  not 
change  between  canonical  maneuvers,  as  they  are  based  on  physical  limitations  of  the 
aircraft. 

A  trim  function  is  used  to  calculate  Thrust  and  AoA  for  each  maneuver  in  order  to 

ensure  that  the  change  in  velocity  and  pitch  is  equal  to  zero  at  the  start  and  end  of  each 

maneuver.  This  allows  the  aircraft  to  initiate  and  terminate  each  the  maneuver  from  level 
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flight.  Each  canonical  maneuver  optimization  is  developed  by  bootstrapping  up  to  64 
nodes.  All  canonical  maneuver  result  plots  are  displayed  with  the  solution  nodes,  each 
displayed  as  an  ‘o’  shape,  as  well  as  the  propagated  solution,  plotted  as  a  solid  line. 

2.  Diagonal  Transfer  Flight 

a.  Description  of  Maneuver 

This  canonical  maneuver  begins  and  ends  on  a  heading  of  zero  degrees,  or 
directly  downrange  in  the  x-direction.  It  is  desired  to  move  the  aircraft  to  a  point  that  is 
1000  meters  away  in  each  direction — x,  y,  and  z — from  the  zero  starting  point.  The 
maneuver  is  complete  when  the  aircraft  is  back  at  straight-and-level  flight  on  the  initial 
heading.  The  arrows  in  Figures  14  and  15  indicate  the  starting  point  and  direction,  and 
the  chevrons  indicate  the  ending  point  and  direction.  This  starting  and  ending  notation  is 
used  in  the  descriptive  figures  for  each  maneuver. 


Figure  14.  Overhead  view  of  Diagonal  Transfer  Maneuver 
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Figure  15.  Diagonal  Maneuver  3-D  View 


This  diagonal  transfer  maneuver  was  selected  as  the  first  canonical 
maneuver  to  demonstrate  in  flight  because  it  would  show  movement  in  all  three 
directions,  accomplishing  a  diagonal  translation,  and  would  also  require  more  than  one 
turn  in  order  to  begin  and  end  on  the  same  heading. 


b.  Initial  and  Final  Conditions 


The  initial  and  final  conditions  for  the  maneuver  describe  the  starting  and 
ending  points  for  the  aircraft’s  maneuver,  as  shown  in  Table  12. 


Initial  Conditions: 


State 

Value 

units 

x0 

0 

m 

yo 

0 

m 

Zo 

100 

m 

Vo 

27.5 

m/s 

Yo 

0 

rad 

Co 

0 

rad 

To 

16.1 

N 

do 

-0.0088 

rad 

ho 

0 

rad 

Final  Conditions: 


State 

Value 

units 

Xf 

1000 

m 

Yf 

1000 

m 

Zf 

1100 

m 

Vf 

27.5 

m/s 

Yf 

0 

rad 

Of 

0 

rad 

Tf 

16.1 

N 

Otf 

-0.0088 

rad 

hr 

0 

Rad 

Table  12.  Initial  and  Final  Conditions  for  Diagonal  Maneuver 
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c.  Box  Constraints 

These  box  constraints  describe  the  limits  on  the  states  and  controls 
throughout  the  maneuver.  The  x,  y,  and  z  bounds  shown  in  Table  13  will  be  different  for 
some  of  the  canonical  maneuvers,  but  the  control  bounds  and  the  bounds  on  all  other 
states  are  the  same  for  all  maneuvers. 


Lower  State  Bounds: 


Value 

units 

XL 

-2000 

m 

Yl 

-2000 

m 

Zl 

0 

m 

Vl 

13 

m/s 

Yl 

-7r/6 

rad 

c>l 

-It 

rad 

tl 

3 

N 

aL 

-71/12 

rad 

4l 

-25 

deg 

Upper  State  Bounds: 


Value 

units 

Xu 

2000 

m 

yu 

2000 

m 

Zu 

1500 

m 

Vu 

42 

m/s 

Yu 

n/6 

rad 

Cu 

71 

rad 

Tu 

35 

N 

(Xu 

71/12 

rad 

Pu 

25 

deg 

Table  13.  State  Bounds  for  Diagonal  Maneuver 


The  time  limit  was  left  long  during  early  test  runs,  and  then  reduced  to 
some  value  comfortably  past  the  end  of  the  maneuver  but  low  enough  to  not  cause  DIDO 
to  search  for  solutions  in  a  very  long  time  window. 

The  event  bounds  in  Table  14  describe  the  endpoint  conditions  for  the 
maneuver.  They  can  constrain  each  state’s  beginning  and  endpoint  to  either  a  range  of 
values  or  to  a  single  value.  In  this  case,  the  start  and  end  points  were  constrained  to  the 
initial  and  final  condition  values,  with  the  exception  of  the  ending  velocity,  which  was 
left  free  to  be  any  number  within  the  allowable  state  bounds. 
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Event  Bounds 


Lower  Upper  _  Lower  Upper 


x0 

x0 

Xf 

Xf 

yo 

Yo 

yf 

yf 

Zo 

Zo 

Zf 

Zf 

Vo 

Vo 

VL 

Vu 

start 

Yo 

Yo 

end 

Yf 

Yf 

Co 

o0 

af 

af 

To 

To 

Tf 

Tf 

a0 

a0 

Of 

Of 

ho 

ho 

hf 

hf 

Table  14.  Event  Bounds  for  Diagonal  Maneuver 


The  control  bounds  in  Table  15  remain  the  same  for  all  canonical 
maneuvers  conducted.  They  are  estimated  from  the  SIMULINK  6DOF  model  and  will  be 
revised  once  actual  flight  tests  are  conducted  to  determine  the  actual  safe  flight 
parameters  of  the  MONARC  aircraft. 


Lower  Control 


Bourn 

Is: 

Value 

units 

UTL 

-1 

N/s 

U„L 

-0.05 

rad /  s 

UuL 

-0.05 

rad/  s 

Upper  Control 


Bound 

is: 

Value 

units 

Utu 

1 

N/s 

UaU 

0.05 

rad /  s 

uuU 

0.05 

rad/  s 

Table  15.  Control  Bounds  for  All  Canonical  Maneuvers 


cl.  Results 

The  x-y  position  view  in  Figure  16  shows  the  path  taken  to  complete  the 
move  as  seen  from  above,  or  approximately  what  the  course  over  ground  would  look  like. 
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Figure  16.  Overhead  View  of  DIDO  Diagonal  Transfer  Trajectory 
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Figure  17.  Diagonal  Trajectory  3-D  View 

The  three-dimensional  view  of  the  maneuver  (Figure  17)  shows  the  path  taken 
through  3-D  space  to  arrive  at  the  desired  endpoint.  A  traditional  autopilot  or  human  pilot 
would  more  likely  fly  a  direct  line  to  the  point,  then  turn  and  straighten  at  the  last 
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moment.  Because  the  maneuver  is  required  to  begin  and  end  at  straight-and-level  flight 
on  the  original  heading,  a  traditional  straight-line  maneuver  would  consist  of  an 
immediate  turn  to  a  course  pointed  towards  the  endpoint.  Shortly  before  reaching  the 
endpoint,  the  aircraft  would  need  to  make  large  and  rapid  changes  to  heading,  pitch,  and 
velocity  to  straighten  and  steady  back  on  the  original  velocity.  This  would  most  likely 
result  in  some  overshoot  and  a  failure  to  exactly  intercept  the  point.  The  time-optimal 
result  is  a  smoother,  more  .S'- shaped  path  achieves  completion  of  the  maneuver  in  about 
65  seconds.  Because  of  the  .S-turn  the  aircraft  is  able  to  line  up  with  the  endpoint  early 
and  approach  the  final  position  with  the  correct  heading. 


Velocity  vs.  Time 


Figure  18.  Velocity  During  the  Diagonal  Transfer  Maneuver 

The  velocity  during  the  maneuver  corresponds  with  the  aircraft  slowing  to 
perform  the  tighter  turns  (see  Figure  18).  The  optimized  climb  from  100m  to  1000m 
shown  in  Figure  19  is  quite  smooth  and  direct,  as  compared  with  the  movement  in  the 
lateral  and  forward  directions,  which  utilizes  the  wide  .S-turn. 
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Altitude  vs.  Time 


Figure  19.  Altitude  Profile  for  Diagonal  Maneuver 


Thrust  vs.  Time 


Figure  20.  Thrust  Profile  for  Diagonal  Maneuver 

To  achieve  the  smooth,  straight  climb  as  shown  in  the  altitude  plot,  the 
maximum  thrust  available  is  used  for  a  significant  portion  of  the  maneuver,  as  shown  in 
Figure  20.  This  highlights  that  while  the  maneuver  may  be  time-optimized,  it  may  be 
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very  costly  in  terms  of  fuel  usage,  and  it  is  important  to  choose  carefully  which  costs  are 
most  valuable  to  minimize  for  a  given  problem.  However,  without  comparison  with  the 
thrust  profile  used  by  a  real  pilot  or  other  autopilot  system,  it  is  hard  to  judge  whether  or 
not  there  is  a  significant  increase  in  fuel  usage.  This  aspect  will  be  investigated  as  part  of 
the  planned  flight  testing. 

The  maneuver  utilizes  the  full  bank  angle  range  available,  reaching  both 
the  upper  and  lower  limits  on  bank  angle,  but  minimal  angle  of  attack  changes  (see 
Figures  21  and  22).  The  unique  turn  shape  is  highlighted  by  the  heading  angle  plot 
(Figure  23)  and  the  flight  path  angle  reaches  maximum  for  the  majority  of  the  maneuver. 


AoA  vs.  Time 


Figure  21.  AoA  vs.  Time  for  Diagonal  Maneuver 
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Bank  Angle  vs.  Time 


Figure  22.  Bank  Angle  vs.  Time  for  Diagonal  Maneuver 


Flight  Path  and  Heading  Angles  vs.  Time 


Figure  23.  Flight  Path  and  Heading  Angles  for  Diagonal  Maneuver 
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To  demonstrate  the  optimality  of  the  maneuver,  the  costates  shown  in 
Figure  24  are  approximately  zero  for  the  x,  y,  and  z  states,  as  expected  from  (3.20)  and 
the  corresponding  discussion  in  Chapter  III.  Figure  25  shows  the  control  and  costate 
comparison  for  the  thrust  variable.  The  curves  behave  as  expected  based  on  the  HMC  as 
discussed  in  Chapter  III. 


Costates 


Figure  24.  Position  Costates  vs.  Time  for  Diagonal  Maneuver 

The  Hamiltonian  value  is  very  close  to  -1  for  most  of  the  duration  of  the 
maneuver,  as  displayed  in  Figure  26.  This  indicates  that  the  maneuver  is  very  close  to 
optimal,  as  discussed  in  Chapter  III  regarding  (3.6).  The  slight  deviation  from  -1,  at  the 
two  end-points,  indicates  that  the  solution  could  benefit  from  increasing  the  number  of 
nodes.  However,  from  an  implementation  point  of  view  this  additional  step  is  not 
necessary. 
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Control  and  costate 


Thrust  Control  and  Costate  Comparison 


Figure  25.  Control  and  Costate  for  Thrust  Variable 


Hamiltonian  vs.  Time 


Figure  26.  Hamiltonian  vs.  Time  for  Diagonal  Maneuver 
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3. 


Wide  U-Turn 


a.  Description  of  Maneuver 

In  this  canonical  maneuver  the  aircraft  performs  a  turn  in  order  to  finish  at 
a  point  1000  meters  laterally  translated  from  the  starting  point,  and  on  the  opposite 
heading.  This  is  a  wide  U-turn  maneuver  (see  Figure  27),  and  was  chosen  as  a 
demonstration  maneuver  because  it  is  the  type  of  turn  commonly  flown  by  aircraft  that 
are  performing  clearing  turns,  conducting  searches,  circling  for  air  control  or  radar 
support  purposes,  or  waiting  to  enter  an  airport  traffic  pattern. 


Figure  27.  Top  View  of  U-tum  Maneuver 
b.  Initial  and  Final  Conditions 

The  x,  y,  z  and  heading  initial  and  final  conditions  are  changed  in  this 
maneuver  to  describe  the  desired  starting  and  finishing  points,  as  shown  in  Table  16. 


53 


Initial  Conditions: 


Final  Conditions: 


State 

Value 

units 

Xf 

0 

m 

Yf 

1000 

m 

Zf 

1000 

m 

Vf 

27.5 

m/s 

Yf 

0 

rad 

cf 

71 

rad 

Tf 

16.1 

N 

Of 

-0.0088 

rad 

M-f 

0 

rad 

State 

Value 

units 

x0 

0 

m 

Yo 

0 

m 

z0 

1000 

m 

v0 

27.5 

m/s 

Yo 

0 

rad 

°o 

0 

rad 

T0 

16.1 

N 

a0 

-0.0088 

rad 

ho 

0 

rad 

Table  16.  Initial  and  Final  Conditions  for  U-tum  Maneuver 


c.  Box  constraints 

In  this  maneuver,  the  x,  y,  and  z  bounds  are  varied  slightly  (see  Table  17) 
to  allow  more  room  for  the  aircraft  to  conduct  the  maneuver. 


Lower  State  Bounds: _  Upper  State  Bounds: 


Value 

units 

xL 

-5000 

m 

Yl 

-5000 

m 

zl 

0 

m 

Vl 

13 

m/s 

Yl 

-n/6 

rad 

ol 

-n 

rad 

tl 

3 

N 

Ul 

-71/12 

rad 

4l 

-25 

deg 

Value 

units 

Xu 

5000 

m 

Yu 

5000 

m 

Zu 

3000 

m 

Vu 

42 

m/s 

Yu 

n/6 

rad 

Ou 

n 

rad 

Tu 

35 

N 

au 

71/12 

rad 

gu 

25 

deg 

Table  17.  State  Bounds  for  U-turn  Maneuver 

d.  Results 

The  optimal  trajectory  solution  found  by  DIDO  within  the  above  conditions  is  a 
maneuver  that  took  about  41  seconds  to  complete.  The  trajectory  as  viewed  from  above 
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in  Figure  28  is  presented  next  to  a  perfect  semi-circle  at  constant  altitude,  to  show  the 
trajectory  that  a  typical  pilot  or  autopilot  might  use.  This  unique  trajectory  shown  in 
Figures  28  and  29  is  not  what  a  typical  pilot  or  autopilot  would  choose  as  a  path  to  turn 
around — changes  in  altitude  are  not  generally  considered  as  part  of  the  maneuver  when 
making  a  simple  U-turn.  An  aircraft  can  make  a  tighter  turn  while  flying  slowly,  such  as 
it  is  does  during  a  climb,  and  can  gain  speed  during  a  descent  to  take  full  advantage  of  the 
aircraft’s  performance  capabilities. 


Figure  28.  Overhead  View  of  Optimized  U-turn  Trajectory  vs. 

a  Semi-Circular  Trajectory 
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Figure  29.  Wide  U-turn  Trajectory  3-D  View 


Velocity  vs.  Time 


Figure  30.  Velocity  During  the  U-turn  Maneuver 
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Altitude  vs.  Time 


Figure  3 1 .  Altitude  Profile  for  U-turn  Maneuver 

The  maximum  velocity  is  reached  and  sustained  during  a  significant  portion  of  the 
maneuver  (Figure  30).  This  corresponds  to  the  altitude  changes  (Figure  31),  as  the 
aircraft  can  be  seen  to  “dive”  to  increase  velocity. 


Thrust  vs.  Time 


Figure  32.  Thrust  Profile  for  U-turn  Maneuver 
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The  thrust  profile  as  seen  in  Figure  32  also  highlights  the  “dive”  performed  by  the 
aircraft.  The  maximum  thrust  is  only  briefly  reached  in  the  middle  of  the  maneuver. 


AoA  vs.  Time 


Figure  33.  AoA  for  U-turn  Maneuver 

Figure  33  shows  the  AoA  over  time  for  the  U-turn  maneuver,  which  only 
changes  only  over  a  small  range,  but  does  so  rapidly. 

The  maximum  allowable  bank  angle  of  25  degrees  is  reached  twice  during  the 
maneuver  (see  Figure  34)  and  the  maximum  flight  path  angle  is  reached  once  (see  Figure 
35).  That  the  aircraft  reaches  limits  for  bank  angle,  velocity,  flight  path  angle  and  thrust 
during  the  maneuver  shows  that  the  optimal  solution  utilizes  the  full  capability  of  the 
aircraft. 
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Bank  Angle  vs.  Time 


Figure  34.  Bank  Angle  for  U-Turn  Maneuver 


Flight  Path  and  Heading  Angles  vs.  Time 


Figure  35.  Flight  Path  and  Heading  Angles  for  U-turn  Maneuver 


59 


4. 


“Scoot  Over” 


a.  Description  of  Maneuver 

This  is  a  similar  maneuver  to  the  U-tum  in  that  the  aircraft  must  translate 
1000  meters  laterally.  The  difference  is  that  the  aircraft  must  finish  on  the  initial 
heading,  as  shown  in  Figure  36.  The  initial  conditions  are  the  same  as  for  the  U-turn,  and 
the  only  difference  in  final  conditions  is  the  heading.  This  maneuver  was  chosen  to  see 
what  optimal  solutions  might  be  found  to  accomplish  something  more  complex,  and  it 
simulates  the  type  of  approach  that  might  be  used  for  a  strafing  run  while  conducting 
close  air  support  operations,  or  when  trying  to  obtain  several  images  of  an  area  from  the 
same  angle.  This  maneuver  is  useful  in  situations  where  the  aircraft  must  come  at  a 
nearby  area  from  the  same  heading.  A  typical  pilot  or  autopilot  might  instead  use  a  wide 
circling  maneuver  to  accomplish  the  same  objective. 


Figure  36.  Top  View  of  “Scoot  Over” 
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b.  Initial  and  Final  Conditions 

The  initial  and  final  conditions  for  this  maneuver  (Table  18)  are  based  on 
the  desired  start  and  end  points  as  well  as  the  straight-and-level  trim  conditions.  The 
boundary  conditions  and  event  bounds  for  this  problem  are  the  same  as  for  the  previous 
maneuver,  the  U-turn. 


Initial  Conditions:  Final  Conditions: 


State 

Value 

units 

x0 

0 

m 

yo 

0 

m 

Zo 

1000 

m 

Vo 

27.5 

m/s 

Yo 

0 

rad 

Co 

0 

rad 

To 

16.1 

N 

a0 

-0.0088 

rad 

ho 

0 

rad 

State 

Value 

units 

Xf 

0 

m 

Yf 

1000 

m 

Zf 

1000 

m 

Vf 

27.5 

m/s 

Yf 

0 

rad 

Of 

0 

rad 

Tf 

16.1 

N 

Of 

-0.0088 

rad 

hr 

0 

rad 

Table  18.  Initial  and  Final  Conditions  for  “Scoot  Over”  Maneuver 

c.  Results 

This  optimal  trajectory  utilizes  a  ‘climb  and  dive’  type  maneuver  similar 
to  that  of  the  U-turn  in  terms  of  altitude  maneuvering,  while  executing  a  wide  S-turn  as 
shown  in  Figures  37  and  38. 


61 


Figure  37.  Overhead  View  of  “Scoot  Over”  Trajectory 
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Figure  38.  “Scoot  Over”  Trajectory  3-D  View 


62 


Velocity  vs.  Time 


Figure  39.  Velocity  Profile  of  “Scoot  Over”  Maneuver 

This  maneuver,  like  the  U-tum,  utilizes  as  much  of  the  aircraft’s 
performance  range  as  possible.  Figure  39  shows  that  the  maximum  velocity  is  reached 
during  the  middle  portion  of  the  trajectory,  but  the  aircraft  also  comes  very  close  to  the 
minimum  velocity,  remaining  just  above  stall  speed. 


Altitude  vs.  Time 


Figure  40.  Altitude  Profile  of  “Scoot  Over”  Maneuver 
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Thrust  vs.  Time 


Figure  41 .  Thrust  Profile  of  “Scoot  Over”  Maneuver 


Maximum  thrust  and  bank  angle  are  once  again  reached  for  this  maneuver 
(Figures  41  and  43),  as  well  as  maximum  flight  path  angle  (Figure  44)  while  the  AoA 
used  in  this  case  is  again  minimal  (Figure  42). 


AoA  vs.  Time 


Figure  42.  AoA  for  “Scoot  Over”  Maneuver 
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Bank  Angle  vs.  Time 


Figure  43.  Bank  Angle  for  “Scoot  Over”  Maneuver 


Flight  Path  and  Heading  Angles  vs.  Time 


Figure  44.  Flight  Path  and  Heading  Angles  for  “Scoot  Over”  Maneuver 

The  maneuver  is  accomplished  in  33  seconds.  This  broad,  5-shaped 
maneuver  is  an  efficient  way  to  bring  an  aircraft  back  over  to  a  nearby  area  on  the 


original  heading  in  the  shortest  time  possible. 
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5.  Narrow-Space  Reversal 

a.  Description  of  Maneuver 

This  maneuver  is  based  on  a  post-stall  maneuver  utilized  by  military  jet 
pilots  as  one  of  a  catalogue  of  primary  moves  for  aerial  combat.  The  objective  of  the 
maneuver,  named  the  Herbst  Reversal  or  Herbst  Maneuver,  is  to  reverse  heading  and 
return  through  the  same  point  from  which  the  maneuver  was  started,  as  quickly  as 
possible  and  in  a  small  amount  of  space  [36].  This  is  shown  in  Figure  45.  Normally  the 
move  utilizes  a  very  high  angle  of  attack,  but  in  this  case  the  AoA  was  left  free  to  be  any 
value  within  the  allowable  range  of  the  aircraft.  The  maneuver  is  performed  in  a  narrow 
space  to  simulate  the  need  to  turn  quickly  and  in  a  tight  section  of  airspace,  as  a  pilot 
engaged  in  aerial  combat  might  need  to  do. 


Figure  45.  Top  View  of  Reversal  Maneuver 


b.  Initial  and  Final  Conditions 

This  maneuver’s  initial  and  final  conditions  are  the  same,  with  the 
exception  of  the  heading,  since  the  goal  is  to  come  straight  back  through  the  starting  point 
in  the  shortest  time  possible  (see  Table  19  and  Figure  45).  The  final  heading  is  opposite 
from  the  initial  heading. 
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Initial  Conditions: 


Final  Conditions: 


State 

Value 

units 

Xf 

0 

m 

Yf 

0 

m 

Zf 

1000 

m 

Vf 

27.5 

m/s 

Yf 

0 

rad 

Of 

71 

rad 

Tf 

16.1 

N 

Of 

-0.0088 

rad 

Pf 

0 

rad 

State 

Value 

units 

x0 

0 

m 

Yo 

0 

m 

z0 

1000 

m 

v0 

27.5 

m/s 

Yo 

0 

rad 

o0 

0 

rad 

T0 

16.1 

N 

a0 

-0.0088 

rad 

Po 

0 

rad 

Table  19.  Initial  and  Final  Conditions  for  Reversal  Maneuver 


c.  Box  constraints 

The  box  constraints  in  Table  23  are  altered  to  force  this  maneuver  to  be 
executed  in  a  narrower  space  than  previous  maneuvers,  making  it  more  similar  to  the 
Herbst  maneuver,  although  still  not  at  stall-inducing  pitch.  The  x-limits  on  the  box  are 
broadened  to  ensure  enough  room  that  a  solution  may  be  found  within  the  narrower  box 
(see  Table  20). 


Lower  State  Bounds: 

Value 

units 

xL 

-5000 

m 

Yl 

-100 

m 

zl 

0 

m 

vl 

13 

m/s 

Yl 

-7r/6 

rad 

ol 

-71 

rad 

tl 

3 

N 

-71/12 

rad 

Pl 

-25 

deg 

1 

Jpper  State  Bounds: 

Value 

units 

Xu 

5000 

m 

Yu 

o 

o 

m 

Zu 

3000 

m 

Vu 

42 

m/s 

Yu 

7l/6 

rad 

Ou 

71 

rad 

Tu 

35 

N 

Ou 

71/12 

rad 

Pu 

25 

deg 

Table  20.  State  Bounds  for  Reversal  Maneuver 
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d.  Results 

The  narrow-area  trajectory  shape  can  be  seen  in  Figures  46  and  47.  The 
optimal  trajectory  is  flown  out  from  the  starting  point  and  then  in  a  tight  loop.  This 
leaves  room  for  the  aircraft  to  line  up  early  to  intercept  the  starting  point  on  the  return 
leg.  To  come  back  through  the  starting  point,  a  conservative  traditional  pilot  or  autopilot 
maneuver  might  perform  either  a  very  large  teardrop  shape  much  wider  than  the  one 
shown  in  Figure  48,  or  a  fighter  pilot  might  execute  a  true  Herbst  Reversal,  which  is  not 
possible  for  the  optimal  maneuver  because  it  is  constrained  to  keep  above  the  stall  speed. 


Figure  46.  Overhead  View  of  Reversal  Trajectory 


This  maneuver  also  demonstrates  that  the  optimal  trajectories  makes  full 
use  of  limits  on  velocity,  as  shown  in  Figure  48,  where  the  aircraft  reaches  both 
maximum  and  minimum  velocity  in  the  same  maneuver.  Since  the  minimum  velocity  is 
reached  for  an  extended  period  of  time  (see  Figure  48),  it  appears  that  it  is  desirable  to 
‘stall’  the  aircraft  as  in  the  Herbst  maneuver. 
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Figure  47.  Reversal  Trajectory  3-D  View 


Velocity  vs.  Time 


Figure  48.  Velocity  Profile  of  Reversal  Trajectory 
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Altitude  vs.  Time 


Figure  49.  Altitude  vs.  Time  for  Reversal  Trajectory 


Thrust  vs.  Time 


Figure  50.  Thrust  Profile  of  Reversal  Trajectory 

The  altitude  change  during  the  maneuver  is  fairly  significant,  as  seen  in 
Figure  49.  Since  the  width  of  the  airspace  allowed  for  this  maneuver  is  reduced,  more 
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vertical  motion  is  required  to  complete  the  turn  within  the  airspace  allotted.  The  thrust 
value  nearly  reaches  the  minimum  allowable  value  in  the  middle  of  the  maneuver  (see 
Figure  50),  as  the  aircraft  slows  to  make  the  tight  turn. 


AoA  and  Bank  Angle  vs.  Time 


Figure  5 1 .  AoA  and  Bank  Angles  for  Reversal  Trajectory 

Once  again  the  maneuver  uses  the  maximum  bank  angle  and  flight  path 
angle  to  complete  the  turns  as  time -efficiently  as  possible,  as  shown  in  Figures  51  and  52. 
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Flight  Path  and  Heading  Angles  vs.  Time 


Figure  52.  Flight  Path  and  Heading  Angles  for  Reversal  Trajectory 

B.  DISCUSSION  OF  THE  CANONICAL  MANEUVERS 

The  canonical  maneuvers  covered  a  range  of  maneuver  types  and  flight  conditions 
to  verify  the  optimization  model  and  determine  that  the  trajectories  being  generated  are 
indeed  feasible.  The  resulting  trajectories  are  generally  not  what  a  typical  autopilot 
system  would  use  to  achieve  the  same  end,  but  rather  are  unique  solutions  to  a  minimum¬ 
time  problem. 

For  most  of  the  maneuvers,  maximum  or  minimum  values  for  several  of  the 
states — including  velocity,  bank  angle,  flight  path  angle,  and  thrust — are  reached,  and  in 
some  cases  both  the  maximum  and  minimum  are  reached  in  the  same  maneuver.  This 
demonstrates  that  the  optimal  trajectories  attempt  to  make  full  use  of  the  aircraft’s 
performance  capabilities  as  allotted.  The  maneuvers  also  show  what  can  be  achieved 
when  breaking  away  from  more  traditional  flight  maneuvers  as  performed  by  a  typical 
autopilot  or  human  pilot,  which  for  example  may  utilize  only  a  small  portion  of  the 
aircraft  performance  envelope. 
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V.  SIMULATION  ENVIRONMENT  FOR  TRAJECTORY 

VERIFICATION 

The  DIDO-generated  trajectories  should  be  verified  using  SIMULINK  and  HIL 
simulations  before  flight.  This  chapter  describes  a  simulation  environment  for 
completing  this  task.  SIMULINK  was  used  to  create  a  6DOF  model  of  the  aircraft  to 
conduct  completely  computer-simulated  flight  of  the  trajectories  within  the  Flight 
Dynamics  and  Control  Toolbox.  SIMULINK  was  also  utilized  for  the  6DOF  model  to 
generate  the  sensor  inputs  for  the  autopilot  HIL  simulation.  The  HIL  simulation  will 
allow  different  maneuver  implementation  strategies  to  be  tested  before  flight. 

A.  AUTOPILOT  SYSTEM 

The  autopilot  system  selected  for  use  (SLUGS)  was  developed  as  a  collaborative 
effort  between  the  Autonomous  Systems  Laboratory  at  the  University  of  California,  Santa 
Cruz  and  Dr.  V.  Dobrokhodov  at  NPS.  The  unmanned  vehicle  guidance  system  was 
developed  as  a  rapidly-reconfigurable  autopilot  system  that  can  be  used  primarily  for 
small  UAVs,  but  also  with  other  unmanned  systems  with  a  wide  variety  of  uses  [3].  The 
autopilot  system  connects  with  a  ground  control  station  and  a  HIL  simulator.  The 
autopilot  board  is  shown  in  Figure  53. 

The  autopilot  hardware  and  software  were  designed  from  the  beginning  to  be 
open-source,  in  order  to  encourage  further  work  and  research  and  development  of  small 
UAV  systems  [37]  to  further  the  field  and  to  determine  just  how  flexible  and 
reconfigurable  the  autopilot  system  can  be. 
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Figure  53.  Autopilot  Board  With  Size  Reference 


1.  Development  and  Description 

While  several  commercial  autopilots  are  readily  available,  all  are  based  off  older 
waypoint  navigation  systems,  and  they  are  not  easy  to  modify  or  reconfigure  for  a 
specific  use  [37].  Since  it  is  anticipated  that  code  modifications  are  necessary  to 
implement  the  optimal  maneuvers,  the  open-source  nature  of  the  MONARC  autopilot 
system  is  crucial.  The  autopilot  software  works  with  SIMULINK’s  automatic  code 
generation  features  to  incorporate  changes  in  the  flight  control  system  without  requiring 
direct  modification  of  the  source  code  [37].  The  iterative  prototyping  process  is  shown  in 
Figure  54. 
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Figure  54.  Control  System  Rapid  Prototyping  Process  (From  [40]) 


One  key  difference  between  the  selected  autopilot  system  and  most  commercial 
autopilots  is  that  the  autopilot  tasks  are  split  between  two  processing  units,  each  operating 
independently.  One  unit  is  used  for  position  and  attitude  estimation,  and  one  for 
navigation  and  control.  The  two  DSCs,  named  sensor  DSC  and  control  DSC,  allow 
higher  processing  power,  and  independent  changes  to  either  unit  that  will  not  impact  the 
other,  as  long  as  the  interface  is  preserved  [38]. 

The  sensor  DSC,  as  the  name  implies,  receives  the  data  from  the  onboard  sensors. 
It  then  uses  that  data  to  compute  the  MONARC’s  attitude  and  position,  via  an  algorithm 
that  fuses  all  available  sensor  data  [37].  The  computed  attitude  and  position  are  sent  via  a 
communication  protocol  to  the  control  DSC.  The  control  DSC  uses  that  data  and  the 
commands  sent  from  the  GCS  to  generate  commands  for  control  surfaces  and  actuators 
[37].  The  control  DSC  also  sends  telemetry  reports  back  to  the  GCS. 
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2.  Components 

The  autopilot  and  its  peripheral  hardware  includes  multiple  sensors,  a  radio 
modem,  digital  signal  controllers  for  sensors  and  controls,  transceivers,  actuators,  and 
regulators  in  a  unique  hardware  architecture  as  shown  in  Figure  55. 

The  autopilot  includes  onboard  sensors  as  well  as  connected  sensors  external  to 
the  autopilot  printed  circuit  board.  The  outputs  of  these  sensors  are  fused  together  for  use 
in  accurately  determining  location  and  controlling  flight.  The  sensor  suite  components 
(see  Table  25)  include  angular  rate  sensors,  accelerometers,  a  barometer,  a  differential 
pressure  sensor,  a  thermometer,  a  battery  monitor,  a  magnetometer,  and  a  GPS  module, 
[39].  The  autopilot  hardware  works  in  conjunction  with  the  QGroundControl  GCS 
system  [30]  to  pilot  the  aircraft.  The  full  list  of  onboard  sensors  for  the  autopilot  control 
function  is  shown  in  Table  21. 


Sensor 

Type(s) 

Notes 

GPS 

Position,  heading,  altitude 

3-axis  IMU 

Position,  attitude 

Accelerometer 

Attitude 

Part  of  IMU 

Magnetometer 

Attitude 

Part  of  IMU 

Rate  Gyro 

Attitude 

Part  of  IMU;  Fused  with 
GPS/accelerometer  via 
complementary  filter 

Static  pressure  sensor  (barometer) 

Altitude 

Dynamic  pressure  sensor 

Airspeed 

Pitot  Tube 

Airspeed 

Table  21.  Autopilot  Sensors  (From  [39],  [41]) 
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Barometer 


Angular  rate 
sensors 


Accelerometers 


Differential 

pressure 


Thermometer 


Battery  monitor 


Aclufltnr  2 


Actuator  10 


12  10  6.0 
Switching 
regulator 

6.0  to  5.0 
Linear 
regulator 

6.0  to  3.3 
Unear 
regulator 

5.0  ESC  to 
3.3  Linear 
regulator 

Figure  55.  Autopilot  Flardware  Architecture  (From  [39]) 


3.  6DOF  SIMULINK  Model 

The  verification  setup  used  for  this  work  includes  a  6DOF  nonlinear  dynamic 
model  of  the  Mentor  aircraft  with  inner  and  outer  loop  simulation  capabilities  (see  Figure 
56). 


4.  Integration  with  MONARC 

The  MONARC  aircraft  can  be  operated  in  manual,  autonomous,  or  HIL  modes. 
The  manual  mode  requires  a  trained  safety  pilot  to  fly  the  aircraft,  the  autopilot  mode 
utilizes  the  autopilot  control  logic  for  waypoint  navigation,  and  the  HIL  mode  provides 
sensor  input  while  still  using  the  autopilot  hardware  to  pilot  a  simulated  aircraft  [42]. 
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The  autopilot  board  is  installed  on  a  modified  portion  of  the  Mentor  fuselage.  The  aircraft 
also  has  slight  modifications  to  facilitate  installation  of  sensors  and  antennae. 


Figure  56.  SIMULINK  Diagram  of  6DOF  Simulator  (From  [27]) 


5.  Navigation 

The  autopilot  performs  waypoint  navigation  using  waypoints  sent  from  the  user 
via  the  ground  control  software.  The  inner  loop  control  portion  is  performed  mainly  by 
the  control  DSC,  and  this  is  shared  between  a  lateral  navigation  channel  for  sideslip  and 
roll,  and  a  longitudinal  navigation  channel  for  altitude  and  speed  [39].  The  split 
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navigation  channels  allow  the  algorithms  to  be  less  complex.  The  outer  loop  navigation 
portion  is  performed  using  the  L2+  waypoint  following  algorithm  [39],  the  details  of 
which  are  beyond  the  scope  of  this  work.  In  order  to  implement  the  optimal  maneuvers 
generated  in  this  thesis  the  outer  loop  navigation  algorithm  will  be  disengaged. 

6.  Ground  Station  Operation 

The  ground  control  software  can  be  run  on  a  laptop  computer,  making  it  portable 
for  flight  tests.  To  conduct  HIL  testing,  the  autopilot  is  put  into  HIL  mode  and  configured 
for  waypoint  navigation  or  commands  may  be  sent  manually  via  the  RC  transmitter.  The 
SIMULINK  6DOF  model  must  be  running,  and  generating  synthetic  sensor  data  to  send 
to  the  hardware. 

B.  HIL  SIMULATION 

A  hardware-in-the-loop  simulator  can  be  used  to  test  the  autopilot  setup  by 
feeding  simulated  sensor  data  to  the  hardware,  so  that  flight  may  be  simulated  and  the 
autopilot’s  functionality  can  be  verified. 

1.  Background 

HIL  simulation  is  invaluable  because  all  actual  autopilot  systems  and  components 
can  be  checked  out  prior  to  flight,  and  avoid  possible  damage  to  the  physical  aircraft  if 
there  is  a  problem.  In  the  case  of  this  work,  the  HIL  simulation  can  verify  that  the  model¬ 
generated  optimized  trajectories  can  be  flown  by  the  aircraft,  and  that  the  optimization 
model  is  in  fact  viable.  Moreover,  the  HIL  setup  can  be  used  to  determine  how  the 
optimal  trajectories  can  best  be  incorporated  into  the  existing  flight  control  loops. 

The  HIL  simulation  operates  as  the  aircraft  will  in  flight,  just  with  simulated 
inputs.  As  system  identification  improves,  the  HIL  simulation  fidelity  will  increase.  The 
HIL  simulator  closely  duplicates  the  flow  of  information  that  would  result  in  physical 
flight  with  the  autopilot  and  gives  a  good  indication  of  how  the  aircraft  would  behave  in 
the  air  [38].  The  autopilot  will  generate  commands  in  response  to  simulated  sensor  input 
received,  and  the  SIMULINK  model  will  respond  to  the  actuator  commands  [43].  This 
forms  a  loop  between  the  simulator  and  the  actual  autopilot  hardware,  where  the  autopilot 
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is  flying  the  simulator  with  actual  commands  sent  to  physical  actuators,  and  back  to  the 
SIMULINK  model  to  provide  feedback  to  the  dynamic  control  system  [35]. 

HIL  simulations  save  on  a  variety  of  costs.  Monetary  costs  are  reduced  because 
tests  do  not  require  rental  of  flight  facilities,  use  of  actual  aircraft,  or  travel  to  flight 
facilities.  As  the  NPS-  and  Navy-approved  flight  test  facility  is  a  several-hour’s  drive 
away,  being  able  to  conduct  HIL  simulations  prior  to  flight  testing  saves  a  great  deal  of 
time  and  expense.  Risk  of  damaging  hardware  in  testing  is  reduced,  and  more  tests  may 
be  completed  in  a  shorter  period  of  time.  Also,  being  able  to  show  results  of  successful 
HIL  testing  will  aid  in  the  flight  approval  processes  required  by  NAVAIR.  While  a  HIL 
simulation  is  not  exactly  the  same  as  a  physical  flight  test,  the  results  are  such  that  the 
number  of  flight  tests  may  be  reduced,  and  conducted  with  a  greater  degree  of  confidence 
that  there  will  not  be  a  catastrophic  failure  because  HIL  tests  have  shown  any  major 
issues  beforehand. 

2.  Apparatus 

The  full  HIL  simulation  apparatus  consists  of  one  desktop  computer  running  the 
SIMULINK  6DOF  model  to  respond  to  commands  and  generate  sensor  inputs;  a  laptop 
computer  equipped  with  the  ground  control  system;  the  manual  aircraft  controller;  and 
the  autopilot.  HIL  mode  can  also  be  used  with  an  entire  MONARC  aircraft  connected.  In 
the  configuration  pictured  in  Figure  57  there  are  servo  motors  connected,  but  the  full 
airframe  is  not  present.  When  the  autopilot  is  operating  in  HIL  mode,  the  simulated 
sensor  data  generated  by  the  SIMULINK  model  is  the  input  [41],  but  the  feedback  and 
commands  from  the  autopilot  are  real — the  actuators  and  motors  move,  and  if  the  full 
MONARC  aircraft  were  connected,  the  control  surfaces  and  propeller  would  also  respond 
to  the  autopilot  commands. 
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Figure  57.  HIL  Simulation  Apparatus  (After  [39]) 


C.  TRAJECTORY  IMPLEMENTATION 

The  SIMULINK  model  (see  Figures  58  and  59)  uses  the  generated  trajectories  as 
inputs  for  the  model  simulations.  The  navigation  control  law  is  designed  so  that  once  the 
aircraft  passes  a  waypoint  the  aircraft  will  attempt  to  steady  on  the  next  leg.  The  control 
laws  within  the  model  include  both  Stability  Augmentation  Systems  and  Control 
Augmentation  Systems  [30].  These  are  shown  in  Figure  55  as  the  SCAS  for  pitch,  roll, 
and  yaw.  The  optimal  trajectory  values  are  interpolated  at  a  100Hz  interval  for  command 
inputs,  as  required  by  the  SIMULINK  autopilot. 

The  control  law  input  setup  can  be  adapted  by  using  the  appropriate  entry  points 
to  insert  various  combinations  of  the  optimal  trajectory  signals,  which  are  then  processed 
by  the  various  loops  to  create  elevator,  rudder,  and  aileron,  and  throttle  commands  to  the 
aircraft. 
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Figure  58.  SIMULINK  Model  of  Mentor — Top  Level  View 
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Figure  59.  SIMULINK  Model — Inside  Control  Laws  Block  Diagram 
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Since  the  optimization  model  is  3DOF  and  is  used  to  send  trajectory  command 
information  to  a  6DOF  autopilot,  values  for  the  Euler  angles  and  Euler  angle  rates  must 
first  be  converted  from  the  available  3DOF  states.  Relevant  equations  [44]  are: 

p  =  p  cos  a  -  a  sin  y  cos  a  -  &  cos  p  cos  y  sin  a  +  y  sin  p  sin  a 
q  =  y  cos //  +  <t  sin //cosy  (5.1) 

r  =  p  sin  a  -  a  sin  y  sin  a  -  &  cos  p  cos  y  cos  a  +  y  sin  p  cos  a 


0  =  sin  1  (sin  a  cos  y  cos  p  +  cos  a  sin  y) 

.  sin  a  sin// 

^  =  cr  +  sin  ( - - — ) 

cos# 

.  cosy  sin  ^ 

^  =  sin  ( - — ) 

cos# 


(5.2) 


(p  =  p  +  q  sin  </>  tan  #  +  r  cos  (p  tan  # 

#  =  r/cos^-rsin^  (5.3) 

sin  (p  cos  (p 

y. f  =  q - +  r - 

cos#  cos# 

The  converted  optimal  trajectories  are  used  as  command  inputs,  and  several 
combinations  of  the  various  available  inputs  were  used  to  determine  which  combination 
worked  best  in  order  to  reproduce  the  optimal  maneuver.  First,  the  simulation  used  inputs 
for  altitude,  velocity,  and  heading  as  shown  in  Figure  60.  Another  alternative  is  to  use 
pitch,  roll,  and  velocity  commands  to  fly  the  trajectory,  as  shown  in  Figure  61.  The 
efficacy  of  each  of  these  approaches  for  maneuver  implementation  is  demonstrated  in  the 
next  chapter. 
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Figure  60.  SIMULINK  Verification  Model  Using  Altitude,  Velocity,  and  Heading  Trajectory 

Inputs  (From  [29]) 
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Figure  61.  SIMULINK  Verification  Model  Using  Pitch,  Roll,  and  Velocity  Trajectory  Inputs 

(From  [29]) 

Other  variations  for  inputs  to  the  6DOF  model  are  possible,  taking  any  of  the 
3DOF  trajectory  states  or  the  converted  Euler  Angles  or  Euler  Rates  and  using  them  for 
the  6DOF  inputs. 
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VI.  MANEUVER  IMPLEMENTATION 


A.  EQUILATERAL  TRIANGLE  MANEUVER 

Two  variations  of  an  optimal  trajectory  were  created  for  the  main  maneuver 
implementation  example,  flying  three  waypoints  to  complete  an  equilateral  triangle.  The 
turn  maneuvers  are  each  the  same  and  can  be  repeated  and  utilized  by  the  autopilot  in  a 
chain  to  complete  an  equilateral  triangle,  with  a  return  to  trimmed  SAL  flight  executed  by 
the  autopilot  in  between  turns. 

This  maneuver  is  an  application  of  the  concept  of  a  library  or  database  of  optimal 
maneuvers  that  can  be  completed  sequentially  to  perform  a  more  complex  maneuver.  In 
this  case,  a  120-degree  turn  is  executed  three  times  to  complete  a  trajectory  based  on  a 
triangle  of  waypoints.  The  equilateral  triangle  maneuver  requires  a  very  sharp  turn,  so  it 
will  challenge  the  controller’s  abilities  to  follow  around  a  tight  turn  more  than  a  square  or 
rectangle,  but  is  also  simple  to  implement  repeatedly  because  the  turn  and  leg  are  the 
same  each  time. 

1.  Minimum  Time  to  Turn  and  Intersect  Next  leg 

First,  a  time-optimal  trajectory  was  generated  to  start  at  the  top  of  the 
triangle,  beginning  on  the  heading  of  the  left-hand  leg,  and  complete  a  120-degree  right 
turn  and  return  to  steady  flight  in  the  shortest  time  possible  on  the  next  leg — the  line 
formed  between  the  top  of  the  triangle  and  the  lower  right  comer  of  the  triangle. 

a.  Description  of  Maneuver 

This  maneuver  performs  a  120-degree  turn  at  the  top  of  an  equilateral 
triangle,  making  the  turn  and  returning  to  steady  flight  along  the  leg  of  the  triangle.  The 
triangle  is  1000m  on  each  side.  The  maneuver  begins  and  ends  at  100m  altitude,  and  the 
top  of  the  triangle  is  considered  the  point  (0,0,100).  The  maneuver  is  depicted  in  Figure 
62. 
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Equilateral  Triangle  Waypoints  -  Top  View 


Figure  62.  Equilateral  Triangle  Maneuver — Complete  Turn  and  Steady  on  Next  Leg 
b.  Updated  Control  Limits 

The  pitch  rate  control  limits  based  on  the  6DOF  computer  model  were 
revised  for  the  chosen  test  trajectory  to  include  the  added  constraint  of  2g  load  limits  as 
recommended  by  the  safety  pilot.  The  load  factors  shown  in  Figure  63  are  for  the  original 
ua  limits,  the  new  limit  to  keep  n  under  2g,  and  an  in-between  value.  The  u„  limit  had  to 
be  reduced  by  nearly  an  order  of  magnitude  to  meet  this  requirement.  The  required 
values  are  listed  in  Table  24. 


Load  Factor  vs.  Time  for  Various  pitch  rate  control  limits 


Figure  63.  Load  Factors  with  Varying  pa  Limits  for  Equilateral  Triangle  Maneuver 
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c.  Initial  and  Final  Conditions  for  Turn  at  Top  of  Triangle 

The  conditions  are  set  up  to  correspond  with  the  maneuver  depicted  in 
Figure  62,  as  shown  in  Tables  22,  23,  and  24. 


Initial  Conditions:  Final  Conditions: 


State 

Value 

units 

Xf 

Xf 

m 

Yf 

yf  -  Xftan(-7i/3) 

m 

Zf 

100 

m 

Vf 

25 

m/s 

Yf 

0 

rad 

Of 

-Jt/3 

rad 

Tf 

15.3 

N 

Of 

0.0193 

rad 

Pf 

0 

rad 

State 

Value 

units 

x0 

0 

m 

yo 

0 

m 

z0 

100 

m 

Vo 

25 

m/s 

Yo 

0 

rad 

Co 

7l/3 

rad 

To 

15.3 

N 

Clo 

0.0193 

rad 

Po 

0 

rad 

Table  22.  Initial  and  Final  Conditions  120-degree  Turn  to  Next  Leg 
d.  Box  Constraints 

Lower  State  Bounds: _  Upper  State  Bounds: _ 


Value 

units 

XU 

1.00E+04 

m 

Yu 

1.00E+04 

m 

Zu 

1000 

m 

Vu 

42 

m/s 

Yu 

n/6 

rad 

Cu 

71 

rad 

Tu 

35 

N 

(Xu 

71/12 

rad 

Pu 

25 

deg 

Value 

units 

xL 

-1.00E+04 

m 

Yl 

-1.00E+04 

m 

zL 

0 

m 

vL 

13 

m/s 

Yl 

-n/6 

rad 

cl 

-n 

rad 

tl 

3 

N 

<xL 

-71/12 

rad 

Pl 

-25 

deg 

Table  23.  State  Bounds  for  120-degree  Turn  to  Next  Leg 
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Lower  Control 


Bounc 

Is: 

Value 

units 

UtL 

-1 

N/s 

UaL 

-0.006 

rad /  s 

-0.05 

rad/  s 

Upper  Control 


Bound 

is: 

Value 

units 

Uxu 

1 

N/s 

UaU 

0.005 

rad /  s 

iLu 

0.05 

rad/  s 

Table  24.  Control  Bounds  for  120-degree  Turn  to  Next  Leg 


e.  Event  Bounds 

The  events  function  for  this  maneuver  had  to  be  written  so  that  the  final 
value  of  x  and  y  was  along  the  line  between  the  first  and  second  waypoints,  as  shown  as 
the  reference  line  in  Figure  and  the  final  values  in  Table  23. 

/.  Trajectory  Comparison  with  Typical  Controller 

First,  the  optimal  trajectory  was  compared  with  the  triangle  maneuver  as 
flown  using  a  typical  autopilot  controller  given  the  same  waypoints,  conditions,  and 
constraints.  As  shown  in  Figure  64,  the  optimized  maneuver  intercepts  the  line  far 
quicker  than  the  standard  controller  maneuver. 

In  the  SIMULINK  Model  with  the  conventional  controller,  the  time  to 
steady  within  2%  of  the  distance  to  the  leg  using  a  typical  controller  was  46  seconds.  The 
optimized  maneuver  to  steady  on  the  next  leg  took  only  28  seconds  to  complete.  This 
was  18  seconds  faster,  or  a  38%  cost  improvement. 
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2D  Trajectory  comparison 


x(m) 

Figure  64.  Trajectories  for  Min  Time  to  Turn  and  Intercept  Next  Leg 

2.  Minimum  Time  to  Turn  and  Arrive  at  Next  Waypoint 

The  other  variation  for  the  triangle  maneuver  was  to  minimize  time  to  turn  and 
reach  the  next  waypoint.  This  would  allow  for  the  maneuver  to  be  conducted  three 
consecutive  times  by  the  autopilot  to  complete  the  triangle  without  any  other  piloting 
required  in  between. 

a.  Description  of  Maneuver 

This  maneuver  is  the  same  as  the  first,  except  rather  than  steadying  on  the 
leg  of  the  triangle,  the  goal  is  to  arrive  in  minimum  time  at  the  next  waypoint,  as  shown 
in  Figure  65. 
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Equilateral  Triangle  Waypoints  -  Top  View 


Figure  65. 


Equilateral  Triangle  Maneuver — Complete  Turn  and  Arrive  at  Next  Waypoint 


b.  Initial  and  Final  Conditions  for  Turn  to  Next  Waypoint 

The  initial  and  final  conditions  for  this  maneuver  are  similar  to  those  for 
the  turn  to  the  next  waypoint,  except  for  the  final  x  and  y  conditions,  as  shown  in  Table 
25.  All  other  bounds  remain  the  same  as  the  previous  maneuver. 


Initial  Conditions:  Final  Conditions: 


State 

Value 

units 

Xf 

500 

m 

Yf 

-866 

m 

Zf 

100 

m 

Vf 

25 

m/s 

Yf 

0 

rad 

Of 

-n/3 

rad 

Tf 

15.296 

N 

Off 

0.0193 

rad 

hr 

0 

rad 

State 

Value 

units 

x0 

0 

m 

yo 

0 

m 

Zo 

100 

m 

Vo 

25 

m/s 

Yo 

0 

rad 

CTO 

n/3 

rad 

To 

15.296 

N 

a0 

0.0193 

rad 

ho 

0 

rad 

Table  25.  Initial  and  Final  Conditions  120-degree  Turn  to  Next  Waypoint 
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c.  Resulting  Trajectories 

The  optimal  trajectory  in  this  case  is  a  much  smoother  path  around  the 
triangle  than  that  of  the  typical  controller  (see  Figure  66).  The  advantage  of  this 
maneuver  over  the  previous  one  is  that  it  can  be  flown  as  three  consecutive  120-degree 
turns  to  the  next  waypoint,  without  other  trajectory  commands  or  autopilot  SAL  flight 
required  between  waypoints.  The  disadvantage,  though,  is  that  it  is  a  much  slower  time 
to  turn  than  in  the  maneuver  to  intersect  the  next  leg. 


2D  Trajectory  comparison 


Figure  66.  Trajectories  for  Minimum  Time  To  Arrive  at  Next  Waypoint 

3.  Optimal  Trajectory  Implementation 

a.  Velocity,  Altitude  and  Heading  Inputs 

The  comparison  has  been  made  between  the  optimal  trajectory  and  a 
typical  controller,  so  the  next  step  is  to  verify  whether  a  conventional  controller  designed 
specifically  for  the  MONARC  can  follow  the  commanded  optimal  trajectories.  The  time- 
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optimal  trajectory  was  sent  to  the  controller  for  implementation  to  determine  whether  the 
controller  could  execute  the  first  turn  of  the  optimal  trajectory  as  shown  for  the  triangle 
maneuver  from  Figure  64. 

In  order  to  verify  that  the  optimal  trajectory  can  be  flown  by  the 
MONARC  controller,  the  optimal  trajectory  was  used  for  the  command  inputs.  The 
control  laws  for  this  controller  are  written  for  pitch,  roll,  yaw,  and  throttle  inputs  (see 
Figures  58  and  59).  As  these  are  not  the  states  generated  for  the  optimal  trajectory,  a 
combination  of  inputs  must  be  selected  and  appropriate  conversions  made  to  use  the 
3DOF  inputs  for  the  6DOF  model  and  control  laws.  The  controller  sampling  rate  is 
50Hz,  so  the  trajectory  states  are  interpolated  at  that  interval  to  provide  trajectory  inputs 
at  the  precise  frequency  required.  The  first  simulation  used  v,  z  and  a  optimal 
trajectory  values  as  command  inputs,  with  the  altitude  and  velocity  inputs  being 
combined  and  converted  for  throttle  command  inputs  and  the  heading  and  altitude  inputs 
being  used  to  generate  commands  for  the  Euler  angles.  The  scheduled  gains  used  for  this 
simulation  were  [45]: 


SAS  Control  Gain 

CAS  Control  Gain 

( 2.0  1 

K=  *1.5 

p  ^0.975  J 

(1.32) 

K.  =  *1.25 

#  h-i  J 

(2.0) 

Ka  =  *1.5 

?  U-oJ 

(l.l  ) 

Kg  =  *2 

U-53J 

(  2.0") 

K,  =  *1 

h.oj 

f0.9l 

K  =  *2 

w  1  0 

(6.1) 

AP  Control  Gain 

K  = 

f  0.5" 

v0.5y 

( 0.008") 

K.  = 

*1.2 

n 

l  0.005  J 

The  trajectory  as  flown  by  the  model  controller  compared  with  the  optimal 
trajectory  commanded  is  shown  in  Figure  67. 
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1000 


2D  Position  comparison 


Figure  67.  Top  view  of  120-degree  Turn  to  Next  Leg  with  v,  z„  a  Inputs 

to  SIMULINK  Model  (From  [45]) 


Altitude  vs.  Time 


Figure  68.  Altitude  profile  of  120-degree  Turn  to  Next  Leg  with  v,  z,  o  Inputs 

to  SIMULINK  Model  (From  [45]) 
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In  this  case  the  trajectory-following  performance  is  not  very  good  because 
the  aircraft  does  not  closely  follow  the  altitude  trajectory  or  the  optimal  velocity 
trajectory.  The  aircraft  does  not  achieve  the  desired  end-states  and  does  not  follow  the 
next  leg  of  the  triangle  after  the  turn.  The  views  of  particular  states  over  time  in  Figures 
67  through  69  help  to  illustrate  what  the  possible  issues  with  this  maneuver 
implementation  are. 

As  shown  in  Figures  68  and  69,  the  autopilot  was  not  able  to  closely 
follow  the  optimal  trajectory  using  these  inputs  even  with  gain  tuning.  The  altitude¬ 
following  performance  was  especially  poor,  likely  because  the  combination  of  these 
inputs  was  not  the  best  for  the  conventional  control  laws  to  follow.  This  also  suggests 
that  new  control  laws  may  be  needed  for  this  aircraft  model. 


Velocity  vs.  time 


Figure  69.  Velocity  profile  for  120-degree  Turn  to  Next  Leg  using  v,  z,  a 

Simulation  Inputs  (From  [45]) 

The  velocity-following  performance  was  better  than  the  pitch  angle 
following,  as  indicated  by  Figure  70.  This  shows  that  the  velocity  input  is  likely  a  good 
choice  for  inputs  from  the  optimal  trajectories  to  the  aircraft  control  system.  The  velocity 
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input  translates  well  for  the  throttle  command  control  law.  However,  the  optimal  altitude 
inputs  cannot  be  tracked  by  the  pitch  control  law. 


Euler  angles  vs.  time 


Figure  70.  Pitch  angle  vs.  Time  for  120-degree  Turn  to  Next  Leg  using  v,  z,  o  as  Simulation 

Inputs  (From  [45]) 


The  pitch  changes  in  the  optimal  trajectory  were  too  steep  for  the  model  to 
follow,  as  shown  in  Figure  70.  This  indicates  that  improvements  may  need  to  be  made  to 
the  pitch  angle  rate  limits  on  the  optimal  control  model,  or  that  another  input  could  be 
tried  to  improve  the  performance. 

The  bank  angle-following  performance  shown  in  Figure  7 1  was 
reasonably  accurate,  but  could  also  be  improved  in  terms  of  both  following  and  overshoot 
amounts.  The  maximum  bank  angle  of  25  degrees  was  exceeded  twice  by  the  controller 
during  this  maneuver.  The  controller  is  not  able  to  follow  angle  changes  fast  enough,  in 
this  case,  due  to  poor  damping  leading  to  excessive  overshoot.  Nonetheless,  the  heading 
control  loop  seems  to  do  a  good  job  at  reproducing  the  desired  bank  angles. 
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Bank  angle  vs.  Time 


Figure  71.  Bank  Angle  vs.  Time  for  120-degree  Turn  to  Next  Leg  (From  [45]) 

Overall,  using  the  v,  z,  a  trajectory  inputs  did  not  produce  a  good  result,  as 
the  changes  in  pitch  angle  were  too  fast  for  the  pitch  tracking  loop  to  handle,  which  in 
turn  led  to  poor  altitude  tracking  [45].  Improvements  would  need  to  be  made  to  the  pitch 
tracking  loop’s  speed,  either  via  a  re-write  of  the  control  laws  or  by  directly  using  the 
already-converted  pitch  angle  as  an  input  to  the  controller. 

b.  Roll,  Pitch  and  Velocity  Optimal  Trajectory  Inputs 

The  second  implementation  used  the  roll  and  pitch  values  converted  from 
the  states  using  (5.2),  plus  the  optimal  velocity  trajectory  as  autopilot  inputs.  The 
scheduled  gains  used  for  this  simulation  were  [45]: 
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SAS  Control  Gain 


CAS  Control  Gain 


KP  = 


KP  = 


K.  = 


2.0 


\ 


0.975  , 
*1.5 


*1.5 


^2.0^ 


vl-0y 

^2.0^ 

vl-Oy 


n 


k,„  = 


K„  = 


1.32 


vl.l  , 
0.1  > 


vl-53y 

f  a  5 


*1.25 


*2 


K  = 


0.9 

vl-0y 


AP  Control  Gain 
^0.5^ 


K  = 


K„  = 


v0.5y 


0.008 

V0.005y 


*1.2 


(6.2) 


As  seen  in  Figure  72,  this  set  of  inputs  produced  a  much  better  trajectory¬ 
following  result. 


2D  Position  comparison 


Figure  72.  Top  view  of  120-degree  Turn  to  Next  Leg  with  v,  <j>,  0  Inputs  to  SIMULINK 

Model  (From  [45]) 
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Altitude  vs.  Time 


Figure  73.  Altitude  profile  of  120-degree  Turn  to  Next  Leg  with  v,  </>,  6  Inputs  to  SIMULINK 

Model  (From  [45]) 

The  altitude  following  performance  is  quite  reasonable  but  still  not  ideal, 
as  shown  in  Figure  73.  At  the  end  of  the  maneuver  the  controller  especially  has  difficulty 
maintaining  the  desired  altitude.  However,  considering  the  range  in  altitude  during  the 
maneuver,  the  altitude  error  at  the  end  is  only  on  the  order  of  10-15%. 

The  pitch-following  performance  of  the  controller  in  this  case  is  quite 
good,  as  compared  to  the  previous  case  (see  Figure  74).  The  velocity-following 
performance  (Figure  75)  is  also  acceptable,  except  in  the  latter  half  of  the  maneuver.  Due 
to  the  issues  with  maintaining  altitude,  when  the  aircraft  does  not  pull  up  fast  enough  the 
velocity  also  increases  beyond  the  commanded  value  during  this  portion  of  the  maneuver, 
as  it  is  not  climbing  as  steeply  as  commanded.  One  way  to  improve  this  performance 
might  be  to  use  thrust  as  the  input  for  the  throttle  control  law  rather  than  velocity. 
Alternatively,  other  improvements  to  the  controller  could  be  tried. 
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Euler  angles  vs.  time 


Figure  74.  Pitch  Angle  vs.  Time  for  with  v,  </>,  6  Inputs  to  SIMULINK  Model  (From  [45]) 


Velocity  vs.  time 


Figure  75.  Velocity  profile  for  120-degree  Turn  to  Next  Leg  with  v,  (j),  9  Inputs  to 

SIMULINK  Model  (From  [45]) 
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Bank  angle  vs.  Time 


Figure  76.  BA  vs.  time  for  120-degree  Turn  to  Next  Leg  with  v,  (j),  6  Inputs  to  SIMULINK 

Model  (From  [45]) 


The  maximum  bank  angle  used  for  the  maneuver  by  the  SIMULINK 
model  exceeds  the  25  degree  bank  angle  limit  imposed  (Figure  76).  This  is  of  concern 
because  the  bank  angle  limit  is  in  place  for  structural  and  safety  concerns.  These  results 
indicate  that  another  consideration  for  improvement  of  the  optimization  model  and 
controller  is  that  there  may  be  a  need  for  allowances  in  case  of  overshoot  of  safety 
constraints  in  the  implementation  of  the  trajectory — the  maximum  thrust,  velocity  and 
bank  angle  for  the  airframe  must  be  included  as  constraints  on  the  controller  as  well  as 
the  optimization  model. 

The  large  bank  angle  values  required  by  the  maneuver  use  comparatively 
large  rudder  angle  commands  to  execute  the  maneuver  while  maintaining  the  sideslip 
suppression  [45],  as  shown  in  Figure  77.  The  flight  control  law,  specifically  the  aileron- 
rudder  interconnects,  may  need  to  be  modified  to  alleviate  this  issue. 
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Time  (sec) 

Figure  77.  Rudder  Angle  used  by  controller  for  120-degree  Turn  to  Next  Leg  with  v,  <f>,  6 

Inputs  to  SIMULINK  Model  (From  [45]) 

Based  on  the  results  from  the  various  combinations  of  controller  inputs,  it 
seems  to  be  best  to  use  the  Euler  Angles  as  inputs  to  the  respective  pitch,  roll  and  yaw 
control  laws  whenever  possible,  to  remove  the  need  for  any  conversion  within  each  loop. 
Accessing  these  innermost  control  loops  would  help  to  improve  speed  and  following  of 
the  optimal  trajectory  commands.  The  throttle  control  input  should  be  tested  with  thrust 
and  velocity  as  inputs  to  determine  which  provides  the  best  performance. 

There  are  many  different  ways  that  the  optimal  maneuver  trajectories 
developed  in  this  thesis  could  be  interfaced  to  the  autopilot  hardware.  Although  the 
combination  of  velocity,  roll  and  pitch  inputs  seems  to  be  most  promising,  the  next  step  is 
to  verify  the  results  by  implementing  the  maneuver  as  a  HIL  simulation.  If  the  results  are 
consistent  with  the  findings  presented  in  this  chapter,  the  maneuver  should  next  be  tested 
in  flight. 
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VII.  CONCLUSION  AND  RECOMMENDATIONS 


A.  CONCLUSIONS 

The  intent  of  this  thesis  was  to  determine  whether  the  selected  hardware  could 
accurately  execute  optimal  trajectories,  and  to  develop  a  model  shown  to  be  of  high 
enough  fidelity  to  generate  optimal  trajectories  without  prohibitively  high  computation 
costs.  Additionally,  this  thesis  was  intended  to  contribute  useful  research  towards  the  end 
goal  of  a  fully  autonomous  aerial  vehicle  in  order  to  expand  the  applications  available  to 
unmanned  vehicles. 

The  reduced-order  3DOF  model  with  simplified  conditions  generates  trajectories 
that  are  flyable  for  the  MONARC  system  within  a  SIMULINK  simulation.  The 
complexity  level  of  the  model  is  such  that  optimal  trajectories  may  be  generated  in  a 
reasonable  amount  of  time,  but  not  yet  to  the  point  where  real-time  optimization  is 
possible.  A  database  of  optimized  maneuvers  could  be  accessed  in  real-time,  though,  and 
used  by  an  autonomous  craft  to  execute  optimal  trajectories  as  commanded. 

The  hardware  was  purchased  and  assembled,  and  a  3DOF  model  of  the 
MONARC  system  was  developed.  The  model  was  used  to  generate  a  number  of 
canonical,  time-optimized  trajectories.  One  trajectory  was  implemented  with  a  6DOF 
controller  in  SIMULINK,  and  shown  to  have  a  significant  time  improvement  over  the 
trajectory  flown  by  a  typical  controller. 

The  kinds  of  canonical  maneuvers  designed  as  part  of  this  thesis  can  be  added 
together  to  make  longer  and  more  complex  trajectories  that  the  MONARC  system  is 
capable  of  flying.  Iterative  improvements  to  the  optimization  model  and  controller  will 
be  needed  as  flight  and  HIL  testing  are  conducted.  While  only  a  flight  test  will  fully 
answer  the  question  of  whether  the  optimal  trajectories  can  be  translated  to  flight  success, 
proof  of  concept  has  been  shown  for  the  ability  of  the  controller  to  receive  and  execute 
commands  from  the  trajectory  and  for  the  time  improvement  of  the  optimal  maneuvers 
over  a  typical  controller.  From  the  simulation  results,  the  MONARC  system  seems  to  be 
capable  of  accurately  executing  the  computer- generated  optimal  maneuvers,  but 
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improvements  to  both  the  model  and  the  controller  may  be  needed  to  consistently  and 
reliably  perform  the  commanded  maneuvers  in  flight. 

B.  FUTURE  IMRPOVEMENTS 

While  valuable,  the  6DOF  HIL  simulations  do  not  completely  validate  the 
autopilot  or  the  aircraft  models.  Flight  testing  is  ultimately  required  to  validate  the  ability 
of  the  MONARC  to  execute  optimal  trajectories. 

1.  Iterative  Upgrades  to  the  Optimization  Model 

The  optimization  model  will  require  iterative  upgrades  as  flight  test  data  is 
collected  and  analyzed.  Adjustments  will  be  made  to  the  control  limits  and  aerodynamic 
coefficients  as  applicable. 

a.  Control  Limits 

The  control  limits  used  as  bounds  in  the  optimization  model  need  to  be 
upgraded  using  flight  test  results  to  better  describe  the  physical  limitations  of  the  aircraft. 
The  thrust,  bank  angle  rate  and  angle  of  attack  rates  will  to  be  updated  as  needed  to 
reflect  the  actual  aircraft  performance  in  flight  tests. 

b.  Physical  Characteristics 

The  final  flight  configuration  with  all  hardware  installed  will  likely  show 
slight  differences  in  aircraft  mass  and  Mol  than  are  used  in  the  current  model.  The 
physical  characteristics  for  the  actual  flight  configuration  will  also  need  be  updated  in  the 
model  in  order  to  generate  new  trajectories  and  iteratively  improve  the  model  to  better 
reflect  the  actual  aircraft. 

2.  Optimization  of  Other  Costs 

While  this  work  covered  only  time-optimal  trajectories,  the  optimization  model 
can  be  modified  to  minimize  or  maximize  for  other  outcomes.  This  may  include 
maximizing  on- station  time  or  coverage  of  a  certain  assigned  area,  or  minimizing  fuel 
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consumption  or  distance  traveled.  This  would  greatly  increase  the  applications  for  which 
the  model  and  the  aircraft  may  be  used.  The  possibilities  are  endless. 

C.  FLIGHT  IMPLEMENTATION  AND  TESTING 

Flight  tests  are  planned  at  McMillan  Air  Field  at  the  Camp  Roberts  Army 
National  Guard  Base  near  Paso  Robles,  California.  The  tests  will  be  conducted  in  military 
airspace  and  meet  NAVAIR  and  NPS  requirements  for  safety  and  procedures.  A  qualified 
safety  pilot  will  fly  the  MONARC  along  with  an  experienced  autopilot  and  ground 
station  operator. 


Figure  78.  Camp  Roberts  Airspace  (From  [40]) 

The  Airspace  for  Camp  Roberts  is  highlighted  in  Figure  78.  The  airstrip  area  is 
boxed,  and  the  airspace  is  outlined. 
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Figure  79.  McMillan  Airfield  at  Camp  Roberts  (From  [40] 

Figure  79  shows  a  closer  view  of  the  box  marked  in  Figure  78,  with  an  overhead 
view  of  the  airstrip. 

Early  flight  tests  of  the  MONARC  should  consist  of  collecting  data  to  improve 
model  coefficients  of  lift  and  drag,  doublet  commands  to  better  determine  control  limits, 
and  confirming  the  inertial  properties.  Once  several  demonstration  flights  have  been 
conducted,  collected  data  can  be  used  to  improve  the  optimization  model,  and  new 
optimal  trajectories  generated.  The  most  important  test  can  then  be  performed — actual 
flight  of  the  optimal  trajectories  by  the  MONARC  aircraft,  as  piloted  autonomously.  That 
test  will  show  with  certainty  whether  the  optimization  model  is  viable  and  how  much 
time  improvement  can  be  achieved  going  from  using  a  generic  control  algorithm  to  fly  a 
maneuver  to  using  one  of  the  generated  optimized  maneuvers. 

The  canonical  maneuvers  should  be  flown  to  verify  the  ability  of  MONARC  to 
perform  simple  and  complex  maneuvers,  and  the  equilateral  triangle  maneuver  and  its 
variations  can  be  tested,  as  well  as  many  similar  maneuvers.  Some  interesting  tests  might 
include  standard  Navy  search  patterns  versus  a  trajectory  optimized  for  area  coverage  or 
minimizing  fuel  use  for  planes  returning  to  base.  The  applications  and  variety  of 
maneuvers  possible  for  the  MONARC  are  myriad,  and  the  aircraft  could  be  a  very  useful 
tool  for  future  development  of  fully  autonomous  aircraft  capable  of  maneuvers  custom- 
optimized  for  a  variety  of  missions. 
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